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Abstract 

This  report  explores  the  design  and  control  issues  associated  with  a  brushless  actuator 
capable  of  achieving  extremely  high  torque  accuracy.  Models  of  several  different  motor 
-  sensor  configurations  were  studied  to  determine  dynamic  characteristics.  A  reaction 
torque  sensor  fixed  to  the  motor  stator  was  implemented  to  decouple  the  transmission 
dynamics  from  the  sensor.  This  resulted  in  a  compact  actuator  with  higher  bandwidth 
and  precision  than  could  be  obtained  with  an  inline  or  joint  sensor. 

Quasi-static  testing  demonstrated  a  closed- loop  torque  accuracy  within  0.1%  over 
the  full  range  of  torques.  Torque  ripple  and  friction  effects,  which  accounted  for  errors 
of  up  to  7%  in  open-loop  tests,  were  virtually  eliminated.  The  mechanical  bandwidth 
of  the  system  approaches  300  Hz,  but  the  current  loop  in  the  drive  electronics  limits 
the  open-loop  bandwidth  to  less  than  10  Hz.  Compensation  techniques  were  utilized 
to  increase  the  controllable  bandwidth  to  greater  than  200  Hz,  demonstrating  that  the 
motor  response  can  be  drastically  improved  by  closing  a  high  bandwidth  torque  loop. 
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Chapter  1 
Introduction 

1.1  Robotic  Capabilities  and  Control 

There  are  many  definitions  for  robots  in  society  today.  Some  consider  numerically  con¬ 
trolled  machines  as  robots,  where  others  restrict  their  view  to  devices  that  assemble  or 
paint  along  an  assembly  line.  Children  envision  androids  like  C3P0,  or  versatile  machines 
that  can  do  anything  such  as  Rosie,  the  automated  maid  on  the  Jetsons.  Isaac  Asimov 
gave  them  a  life-like  appearance  and  personality,  and  even  the  ability  to  read  minds. 

Unfortunately,  the  state  of  the  art  in  robotics  is  not  quite  that  advanced.  Most 
robots  can  only  follow  preprogrammed  commands,  and  are  typically  used  for  assembly, 
painting,  or  materials  handling.  Those  more  advanced  can  make  remedial  decisions  based 
upon  some  sensor  inputs.  Research  is  taking  place  to  enable  machines  to  ‘learn’  through 
neural  networks.  The  Mobile  Robotics  group  in  the  MIT  Artificial  Intelligence  lab  has 
built  several  mechanical  creatures  with  embedded  behaviors.  These  devices  can  respond 
to  various  stimuli:  light,  sound,  movement.  By  layering  these  different  behaviors,  the 
robots  are  given  a  limited  personality.  Truly  human  reasoning,  however,  is  still  a  long 
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way  off. 

In  the  near  future,  robotics  will  play  a  major  role  in  building  and  maintaining  the 
space  station.  They  will  be  required  to  be  agile  and  quick,  capable  of  moving  massive 
loads,  yet  delicate  enough  to  fasten  connectors.  Unstructured  environments  such  as  space 
or  undersea  present  a  great  challenge  to  the  field  of  robotics,  since  programmed  behaviors 
can  be  inadequate  as  the  situation  changes.  Long  communication  delays  prohibit  purely 
teleoperated  mechanisms.  Future  manipulators  will  need  to  be  autonomous,  and  prepared 
for  a  variety  of  unexpected  occurances.  They  will  also  be  required  to  be  versatile,  as 
NASA  would  prefer  to  send  up  one  general  purpose  device  rather  than  several  machines, 
each  capable  of  performing  only  a  single  function. 

1.1.1  Force  Control 

In  virtually  all  robotic  applications,  it  is  necessary  to  interact  with  the  environment 
to  achieve  a  task.  Many  of  these  tasks  require  precise  control  of  forces  to  effectively 
manipulate  an  object  without  damage  to  it  or  the  robotic  device.  It  is  desirable  to 
control  contact  forces  while  executing  assembly  or  pick  and  place  tasks,  as  well  as  being 
able  to  monitor  any  collisions.  As  tasks  become  more  complex  and  environments  less 
structured,  there  will  be  an  even  greater  need  for  accurate,  high  bandwidth  force  control. 
One  of  the  major  thrusts  of  current  robotics  research  is  therefore  in  the  area  of  force 
control. 

An  overview  of  the  history  of  force  control  was  presented  by  Whitney  [Whitney  85]. 
He  reviewed  the  major  strategies  involved  in  force  control  and  analyzed  stability.  Maples 
[Maples  86]  described  and  categorized  some  of  these  methods. 
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Force  control  techniques  can  be  categorized  as  passive,  active,  or  a  combination  of  the 
two.  Passive  methods  are  best  represented  by  Remote  Center  Compliance  (RCC)  devices. 
This  device  was  developed  by  Drake  [Drake  77]  at  Draper  labs  and  uses  compliance  to 
control  and  limit  forces  at  the  end-effector. 

In  active  force  control,  manipulator  forces  are  controUed  through  actuator  commands. 
In  some  cases,  feedforward  control  is  sufficient  to  achieve  the  desired  force  accuracy.  In 
this  method,  the  joint  torques  are  adjusted  through  servo  gains  to  achieve  the  desired  ma¬ 
nipulator  stiffness.  This  implicit  force  control  is  suitable  when  the  manipulator  dynamics 
are  known,  and  the  environment  is  predetermined  and  relatively  static.  An  [An  86]  used 
a  type  of  implicit  control  on  the  MIT  Serial  Link  Direct  Drive  Arm  to  control  the  inter¬ 
action  force  at  the  end-effector. 

Paul  [Paul  72]  precomputed  the  required  torques  using  Lagrangian  equations.  This 
computed  torque  was  then  the  command  torque  at  the  joint.  As  the  manipulator  moved, 
its  dynamics  changed,  requiring  computation  of  a  new  torque  command.  This  approach 
used  laijje  amounts  of  processing  time  due  to  the  complexity  of  accurate  dynamic  equa¬ 
tions. 

The  addition  of  force  sensors  enables  higher  precision  feedback  control.  There  are 
four  groups  undn  which  feedback  control  can  be  identified.  The  first  type  as  described 
in  Whitney  [Whitney  77]  is  damping  control.  This  method  uses  an  inverse  damping 
matrix  to  transform  forces  into  joint  velocity  commands.  Abramowitz  [Abramowitz  84] 
varied  the  velocity  feedback  gains  at  the  joints  to  achieve  his  version  of  damping  control 
without  an  inverse  damping  matrix. 
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Another  type  of  active  force  control  is  stiffness  control  [Salisbury  80].  This  method 
uses  proportional  gains  to  realize  a  linear  relationship  between  posiic'on  error  and  com¬ 
manded  force.  At  a  specified  position,  the  desired  force  is  commanded  open  loop.  If  the 
forces  are  unbalanced,  the  robot  and  object  (or  flexible  environment)  will  move  until  aU 
forces  are  equal,  or  the  proportional  position  error  times  the  specified  stiflhess  exactly 
cancels  the  force  command. 

Impedance  control,  as  described  by  Hogan  [Hogan  85],  determines  the  command  forces 
based  on  position,  velocity,  and  acceleration  deviations.  Damping  and  stiffness  matrices 
are  used  to  convert  these  errors  into  actuator  commands.  This  method  combines  the 
advantages  of  both  the  damping  and  stifl[hess  methods  described  above. 

The  fourth  type  offeree  control  is  hybrid  positon/force  control  [Raibert  and  Craig  81]. 
Two  control  systems  are  used  simultaneously  to  close  both  position  and  force  control 
loops.  This  is  a  very  accurate  method  when  both  the  position  and  force  need  to  be 
controlled  precisely. 

The  placement  of  the  force  sensor(s)  plays  a  major  part  in  the  choice  of  control  scheme. 
Raibert  and  Craig  used  the  Scheinman  sensing  wrist  in  their  hybrid  position/force  control 
loops.  Salisbury  [Salisbury  80]  added  a  deadband  to  reduce  limit  cycling  and  nonlinear 
limiting  to  minimize  loop  gain  due  to  large  force  errors  resulting  from  impacts.  The 
Jacobian  transform  was  used  to  resolve  wrist  forces  into  joint  torques. 

Several  studies  have  shown  that  locating  the  force  sensor  on  the  end  effector  is  unstable 
when  in  contact  with  a  stiff  environment.  Whitney  [Whitney  77]  showed  that  the  stability 
was  dependent  on  the  compliance  between  the  sensor  and  the  environment.  In  the  case 
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of  a  very  stiff  environment,  the  sensor  should  be  covered  with  a  compliant  surface.  An 
[An  86]  supported  this  by  modeling  the  force  control  loop  as  a  high  gain  position  feedback 
scheme.  The  compliant  cover  on  the  sensor  would  lower  the  effective  gain  and  therefore 
increase  stability. 

In  other  research  [Eppinger  87],  the  manipulator  dynamics  between  the  sensor  and 
the  actuators  added  poles  to  the  system  and  often  led  to  instabilities.  These  dynamic 
effects  could  be  removed  by  colocating  the  sensor  and  actuator,  and  closing  joint  torque 
loops  rather  than  endpoint  force  loops.  An  [An  86]  suggested  a  combination  of  joint  and 
endpoint  sensing.  The  joint  torque  control  would  be  used  for  stable  dynamic  behavior, 
and  the  force  sensor  would  provide  higher  steady  state  accuracy. 

Joint  torque  sensors  have  also  been  shown  to  increase  the  system  bandwidth.  Wu 
and  Paul  [Wu  80]  used  a  linear  model  on  a  single  link  manipulator  with  joint  sensing. 
The  analog  hardware  closed  the  loop  directly  around  the  joint,  avoiding  the  calculations 
associated  with  the  Jacobian.  This  allowed  a  much  higher  bandwidth  with  very  fast 
response.  Luh,  Fisher,  and  Paul  [Luh  83]  extended  this  analysis  to  include  the  first 
two  joints  of  the  Stanford  Scheinman  manipulator.  They  modeled  each  joint  as  a  linear 
system  with  a  backlash  nonlinearity  for  the  harmonic  drive. 

Cannon  and  Rosenthal  [Cannon  84]  investigated  manipulators  with  non-colocated 
actuators  and  sensors.  While  stable  control  loops  were  easily  obtained  for  colocated 
sensors,  it  was  much  more  difficult  when  the  sensors  and  actuators  were  non-colocated, 
especially  in  a  flexible  system.  This  research  was  extended  [Tilley  86]  with  the  addition 
of  a  fast  end-effector  to  a  flexible  manipulator.  The  wrist  subsystem  employed  its  own 
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force  loop  upon  cont&ct.  This  force  controller  recognized  movement  of  the  main  link  as 
a  disturbance  and  improved  the  response  of  the  flexible  manipulator. 

Several  other  researchers  designed  arms  spedflcally  for  force  control.  Asada  and 
Kanade  [Asada,  Kanade  81]  designed  a  direct  drive  arm  to  diminate  transmission  back¬ 
lash  and  reduce  limit  cycling.  Youcef-Toumi  [Youcef-Toumi  87]  showed  that  the  decou¬ 
pled  dynamics  of  his  direct  drive  arm  greatly  simplified  the  computations  required  for 
surface  following.  As  with  other  direct  drive  manipulators,  this  design  exhibited  fast 
actuator  dynamics,  low  friction,  and  no  mechanical  backlash. 

1.1.2  Whole- Arm  Manipulation 

A  new  area  of  manipulator  research  involving  force  control  is  Whole-Arm  Maniprdation. 
First  described  by  Salisbury  [Salisbury  87],  this  method  uses  all  the  link  surfaces  for 
manipulation,  rather  than  just  the  end-effector. 

Several  advantages  are  gained  by  using  the  links  in  addition  to  the  endpoint.  Larger 
objects  can  be  grasped  between  the  lower  and  upper  links.  Large  forces  can  be  exerted 
by  moving  the  center  of  mass  of  the  object  to  a  point  on  the  arm  closer  to  the  base. 
Collisions  can  be  detected  at  any  point  on  the  device,  rather  than  where  the  sensor  is 
placed.  This  type  of  manipulator  would  be  desirable  in  an  unstructured  environment 
such  as  space  or  undersea,  where  tasks  vary  widely,  and  collisions  are  inevitable.  A 
further  extension  to  the  concept  of  WKoh-Arm  Manipulation  would  consist  of  several 
WAMs  grouped  together  to  form  a  much  larger  manipulator.  If  each  WAM  also  carried 
a  small  dexterous  hand,  the  system  would  be  capable  of  handling  objects  ranging  from 
very  small  to  those  as  large  as  the  manipulators  themselves. 
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As  described  in  Salisbury  et.  al.  [Salisbury  88],  several  things  must  be  taken  into 
consideration  when  designing  a  JVAM.  Since  the  primary  application  of  this  system  is  to 
manipulate  'ud  detect  objects  in  unstructured  environments,  forces  must  be  controllable 
anywhere  iong  the  links.  It  is  therefore  a  necessity  for  the  manipulator  to  have  precise 
and  reliable  joint  torque  control  and  sensing.  In  order  to  maximise  the  contact  area  of 
the  links,  they  should  be  long  and  narrow,  providing  a  large  workspace.  The  links  should 
also  be  free  of  protruding  cables  and  actuators,  so  as  not  to  interfere  with  manipulative 
tasks.  To  increase  speed  and  payload  capability,  the  motors  should  be  located  as  close 
to  the  base  as  possible. 

In  view  of  these  requirements,  Whole-Arm  Manipulators  were  built  at  the  MIT  Artifi¬ 
cial  Intelligence  Laboratory  [Townsend  88]  and  the  Woods  Hole  Oceanographic  Institute 
[DiPietro  88).  The  MIT  WAM  (figure  1.1.2)  was  designed  to  be  inherently  force  con¬ 
trollable.  Its  cable  transmission  is  highly  efficient,  with  virtually  no  friction  and  xero 
backlash.  The  resulting  backdrivability  makes  it  possible  to  sense  link  forces  from  motor 
torques.  The  links  are  lightweight  with  a  high  aspect  ratio.  This  high  performance 
mimipulator  has  shifted  the  limiting  constraints  on  force  accuracy  and  band¬ 
width  from  the  transmission  and  structure  to  the  motors. 

The  existing  WAM  control  system  uses  coxnmanded  motor  current  to  estimate  the 
torque,  and  provides  for  feedforward  ripple  compensation.  The  sensors,  ripple,  friction, 
and  other  factors  limit  the  open  loop  torque  accuracy  to  about  8%  of  full  output.  Paul 
[Paul  87]  and  Eberman  [Eberman  89a]  used  feedforward  ripple  compensation  to  reduce 
the  error  to  about  5%.  While  this  may  be  acceptable  for  some  feedforward  force  appli- 
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cation,  it  catues  aigniiicant  errors  when  used  for  point  of  collision  detection,  where  poor 
solution  conditioning  may  require  precise  torque  measurement  [Eberman  89b].  Salisbury 
et.  al.  [Salisbury  89]  discusses  the  control  system  and  performance  of  the  MIT  WAM. 

1.2  Thesis  Overview 

The  purpose  of  this  research  was  to  develop  and  implement  a  torque  actuator  capable 
of  meeting  the  performance  needs  of  the  WAM.  The  actuator  required  precise  torque 
control,  a  large  dynamic  range,  and  high  bandwidth.  Additionally,  it  had  to  be  physically 
compatible  with  the  existing  manipulator. 
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Chapter  2  provides  some  background  on  torque  control,  and  illustrates  some  of  the 
popular  methods.  It  also  describes  some  of  the  theory  and  analysis  that  went  into  the 
design  and  choice  of  the  major  components.  It  includes  descriptions  and  tradeoffs  of 
motors,  sensors,  and  controllers. 

Chapter  3  presents  a  brief  summary  of  the  actuator  design  including  components, 
layout,  and  design  requirements/specifications.  Controller  architecture  and  software  con¬ 
siderations  are  also  included. 

Chapter  4  presents  a  model  of  the  actuator  system.  The  characteristics  of  DC  motors 
are  formulated.  Transfer  functions  for  the  motor,  sensor,  and  controller  are  derived. 
The  motor  and  sensor  bandwidths  are  estimated.  Nonlinear  disturbances  such  as  torque 
ripple  and  friction  are  also  discussed. 

Chapter  5  details  the  performance  of  the  open  and  closed  loop  systems.  Torque  ac¬ 
curacy  and  bandwidth  are  discussed  in  detail.  Figures  include  quasistatic  torque  output, 
frequency  response,  and  time  response.  The  effects  of  torque  ripple  and  friction  are  also 
illustrated. 

Chapter  6  summarizes  the  success  of  this  project  in  meeting  its  goals.  Problem  areas 
and  suggestions  for  improvement  are  included. 


Chapter  2 

Torque  Control  Design 
Considerations 

There  exist  two  basic  forms  of  torque  control:  open  loop  control  assumes  that  an  accu> 
rate  model  of  the  system  exists  and  all  errors  can  be  minimized  using  the  appropriate 
feedforward  techniques;  feedback  control,  on  the  other  hand,  does  not  require  as  precise 
a  system  model,  but  utilizes  a  traiuducer  to  determine  the  torque  error. 

Open  loop  torque  control  does  not  require  a  torque  sensor,  so  is  generally  less  costly 
to  implement.  For  tasks  that  do  not  require  high  torque  accuracy,  the  motor  can  be 
modelled  as  a  simple  linear  gain.  Most  DC  motors  haye  well  behaved  torque  constants 
over  their  operating  range.  For  applications  where  dynamic  response  or  high  accuracy  is 
important,  an  accurate  system  model  is  necessary  to  predict  the  output  torque.  Inherent 
system  disturbances  such  as  torque  ripple  and  bearing  friction  may  require  nonlinear 
feedforward  control  laws.  In  the  case  of  ripple,  a  lookup  table  containing  the  zero  speed 
ripple  as  a  function  of  shaft  angle  is  often  used.  Torque  ripple  will  be  discussed  in  more 
detail  in  chapter  4. 


17 


CHAPTER  2.  TORQUE  CONTROL  DESIGN  CONSIDERATIONS 


18 


Feedback  control,  on  the  other  hand,  does  not  require  an  extremely  accurate  dynamic 
model  of  the  motor.  The  output  torque  can  be  determined  more  precisely  and  fed  back 
for  comparision  with  the  command.  The  controller  can  then  compensate  for  all  the  errors 
simultaneously  without  distinguishing  between  the  sources. 

There  are  many  ways  of  feeding  back  the  torque  information.  The  least  complicated 
involves  measuring  the  currents  flowing  to  the  motor.  Since  the  torque  constant  makes 
this  a  theoretically  linear  relationship,  the  actual  torque  can  be  observed  fairly  accurately. 
Unfortunately,  this  technique  does  not  include  non*linearities  such  as  friction,  ripple,  and 
dynamic  effects  which  can  typically  cause  errors  of  up  to  10%.  For  this  reason,  feedback 
of  the  actual  system  torque  is  required. 

The  introduction  of  a  torque  sensor  provides  precise  information  about  the  torque 
state  of  the  system.  The  selection  of  the  sensor  should  be  matched  to  the  application  for 
the  highest  possible  bandwidth  and  resolution.  The  tradeoffs  in  sensor  designs  will  be 
discussed  later  in  this  chapter. 

2.1  Bandwidth  and  Dynamic  Range 

The  two  most  significant  factors  in  designing  a  torque  controller  are  the  system  bandwidth 
and  the  dynamic  range  of  torque  controllability.  The  bandwidth  is  a  measure  of  how 
quickly  the  system  will  respond  to  disturbances  or  changes  in  the  command.  Factors 
which  influence  bandwidth  include  electrical  and  mechanical  time  constants,  sampling 
and  servo  rates,  and  mass-compliance  ratio  of  the  system.  The  dynamic  range  is  a  ratio 
relating  the  maximum  output  torque  to  the  torque  precision.  This  value  is  dimensionless 
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Figtue  2.1:  A  Two  Stage  Cable  Trantmusion. 

and  is  useful  in  comparing  small  actuators  with  highly  accurate  torque  output  against 
actuators  having  a  wider  operating  range,  but  lower  accuracy.  Both  the  motor  and 
sensors  need  to  be  chosen  to  satisfy  the  full  range  of  torques,  yet  maintain  high  accuracy 
and  sensitivity.  A  brief  description  of  the  design  and  characteristics  of  the  MIT  WAM 
will  provide  some  performance  guidelines. 

2.1.1  Whole  Arm  Manipulator  Design 

The  WAMnaez  a  novel  cable  transmission  to  link  the  motors  with  the  joints  [Townsend  88}. 
The  two  stage  configuration  also  acts  as  a  reduction  with  ratios  of  30:1  in  the  first  three 
joints  and  20:1  in  the  fourth  joint.  Where  long  cable  lengths  are  required,  such  as  in  the 
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fourth,  joint,  the  high  speed  first  stage  cable  is  used,  as  seen  in  Figure  2.1.  The  effective 
stiffness  of  this  cable  at  the  output  can  be  estimated  by  multiplying  the  low  tension 
stiffness  by  the  transmission  ratio  squared.  In  addition  to  high  stiffness,  the  cable  trans¬ 
mission  virtually  eliminates  the  deadband  associated  with  backlash,  and  has  very  low 
friction.  Forward  and  reverse  efficiencies  are  both  above  95%,  making  the  arm  extremely 
backdrivable. 

Each  of  the  four  joints  is  driven  by  a  Moog  303-003  DC  brushless  motors.  These 
motors  are  capable  of  a  torque  output  of  15  in-lb  continuous  with  peaks  up  to  60  in-lb.  A 
resolver  is  mounted  on  the  shaft  of  each  motor  for  position  and  commutation  information. 
The  drive  pinions  affixed  to  the  motor  shafts  are  composed  of  two  halves.  One  half  may 
be  rotated  relative  to  the  other  to  pretension  the  cables. 

The  current  MIT  WAM  control  system  uses  a  form  of  open-loop  torque  control.  It 
incorporates  some  feedforward  compensation  to  reduce  the  effects  of  torque  ripple  and 
cogging.  Unfortunately,  the  highest  accuracy  possible  with  this  system  is  on  the  order 
of  5%  of  full  torque.  This  gives  the  system  a  dynamic  range  of  about  20:1.  One  of 
the  design  goals  of  this  research  was  to  improve  the  torque  accuracy  to  below  1%  of 
full  torque,  increasing  the  dynamic  range  to  greater  than  100:1.  Since  this  degree  of 
accuracy  would  be  very  difficult  to  achieve  with  feedforward  compensation  (due  to  high 
order  ripple  harmonics,  bearing  stiction,  and  other  time-varying  and  nonlinear  effects), 
the  design  effort  was  focused  on  a  feedback  system  utilizing  a  torque  sensor. 

Eberman  [Ebennan  89a]  measured  the  stiifriess  of  the  transmission.  He  found  that 
the  stiffness  at  the  motor  of  the  cables  in  the  fourth  Knk  were  approximately  40  in- 
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Ib/rad.  The  effective  atiffness  is  increased  by  the  square  of  the  transmiasion  ratio  to 
16,000  in-lb/rad  at  the  joint.  Since  this  joint  has  the  longest  free  length  of  cable,  all  of 
the  other  joints  will  have  a  slightly  higher  stiffness.  Ebennan  also  measured  the  natural 
frequencies  of  the  manipulator  in  free  vibration.  The  fourth  link,  although  it  had  the 
lowest  sti&ess,  had  the  highest  natural  frequency,  at  56  Hz,  due  to  its  extremely  low 
mass.  This  is  the  resonant  frequency  of  interaction  between  the  motor  and  the  link  mass 
through  the  transmission  stiffness.  The  damping  ratio  was  found  to  be  about  0.3.  Since 
these  tests  were  conducted,  the  last  link  has  been  replaced  with  one  having  about  3 
times  the  mass  of  the  original,  which  would  lower  the  natural  frequency  significantly. 
The  natural  frequency  of  the  base  joint  was  observed  to  be  44  Hz,  which  is  the  lowest 
of  the  four,  and  had  a  damping  ratio  near  0.6.  The  implemented  control  system  was 
capable  of  obtaining  a  closed  loop  natural  frequency  of  2  Hz  with  a  damping  ratio  of  0.5 
under  position  control. 

2.1.2  Actuator  Design  Goals 

Based  on  the  characteristics,  some  basic  guidelines  were  developed  for  the  actuator: 

Continuous  output  torque:  ±15  in-lb 

Torque  accuracy:  <0.15  in-lb 

Bandwidth:  >  100  Hz. 

Diameter:  <  3.00  in 

Length: 


<  7.00  in 
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Figure  2.2:  Conventional  DC  Motor  Layout. 


These  baseline  figures  assure  compatibility  with  the  WAM,  and  enable  the  system  to 
detect  all  torque  variations  below  the  manipulator  natural  frequencies. 

2.2  Design  Options 

This  section  will  discuss  some  of  the  various  technologies  that  could  be  used  in  the 
development  of  the  actuator.  The  characteristics  of  each  will  be  examined  to  determine 
if  it  will  satisfy  design  guidelines  and  provide  robust,  accurate  torque  control. 

2.2.1  Motor  Selection 

The  first  decision  that  must  be  made  when  choosing  an  electric  motor  is  whether  it  has 
brushes  or  is  electrically  commutated.  This  section  will  describe  both  types  of  motor  and 
present  the  benefits  and  disadvantages  of  each. 

Conventional  DC  motors  are  constructed  with  permanent  magnets  on  the  stator, 
phase  windings  on  the  rotor,  and  internal  commutation  brushes  to  mechanically  switch 
motor  current.  By  moving  with  the  rotor,  the  commutation  brushes  effectively  maintain 
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a  stationary  rotor  current  field,  properly  aligned  with  the  stator  magnetic  field,  regardless 
of  rotor  position.  Torque  is  produced  by  the  interaction  of  the  permanent  magnet  induced 
flux  with  the  phase  winding  current  rector.  The  layout  of  a  typical  DC  brushed  motor 
can  be  seen  in  figure  2.2. 

A  brushless  motor  is  essentially  an  Hnside  out*  brushed  motor.  The  phase  windings  are 
located  on  the  stator,  with  the  permanent  magnets  mounted  on  the  rotor.  Commutation 
is  achieved  by  alternately  energizing  the  motor  phases  through  electronic  switching.  The 
rotor  position  is  required  to  smoothly  commutate  the  motor.  Several  feedback  devices 
can  be  used  for  this  purpose:  Hall  effect  sensors,  resolvers,  and  encoders.  Many  brushless 
motor  drivers  use  current  feedback  to  accurately  contnd  the  current  flow  lo  the  motor. 
Commutation  schemes  can  be  as  simple  turning  the  phases  on  and  off  when  the  mag¬ 
nets  are  in  the  correct  orientations,  to  continuously  varying  the  current  to  each  phase. 
The  latter  method  is  referred  to  as  sine-wave  commutation,  and  produces  a  significantly 
smoother  torque  than  trapezoidal  commutation.  A  layout  of  the  basic  components  of  a 
brushless  motor  can  be  seen  in  figure  2.3. 


CHAPTER  2.  TORQUE  CONTROL  DESIGN  CONSIDERATIONS 


24 


The  following  motor  characteristics  are  pertinent  to  this  application: 

•  Brush  fnction-  as  a  result  of  mechanical  commutation,  there  is  a  measurable  fric¬ 
tion  in  brushed  motors.  The  only  friction  in  brushless  motors  is  due  to  the  bearings. 
The  amount  of  static  friction  in  the  motor  will  adfect  its  torque  deadband  and  limit  its 
accuracy. 

•  Switching  noise-  brushed  motors  radiate  large  amounts  of  electrical  noise  as  the 
brushes  contact  the  commutator  segments.  The  frequency  of  this  noise  is  proportional 
to  the  speed  of  the  motor.  Brushless  motors  exhibit  switching  noise  at  the  controller  as 
each  phase  is  energized.  Very  high  frequency  noise  occurs  if  Pulse  Width  Modulation  is 
used,  due  to  the  transistors  switching  state. 

•  Thermal  Constant-  Since  the  windings  on  a  brushed  motor  are  on  the  rotor,  its 
heat  is  dissipated  primarily  by  convection.  Brushless  motors,  on  the  other  hand,  have 
their  coils  on  the  stator.  This  allows  them  to  cool  through  conduction  and  convection, 
enabling  them  to  run  longer  before  heating  up. 

•  Phase  number-  brushed  motors  typically  have  from  2-12  electrical  phases.  Each 
is  simply  a  coil  wound  on  the  rotor  laminations.  Brushless  motors,  however,  rarely  have 
more  than  three  phases.  The  reason  for  this  is  that  each  phase  requires  its  own  dedicated 
power  circuitry  to  correctly  commutate  it.  While  winding  a  few  extra  coils  is  relatively 
inexpensive,  adding  three  more  phases  to  a  brushless  motor  may  double  or  triple  the 
cost  of  the  drive  electronics.  The  number  of  phases  can  significantly  affect  the  amount  of 
ripple  in  a  motor.  In  trapezoidal  or  brushed  commutation,  the  phase  current  is  constant 
for  a  finite  angle.  The  flux  density,  however,  varies  as  the  rotor  moves  relative  to  the 
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st&tor,  producing  a  fluctuating  torque.  The  greater  the  distance  between  phases,  the 
greater  the  ripple.  Hence,  a  motor  with  6  phases  will  have  inherently  less  ripple  than  an 
otherwise  identical  motor  with  3  phases. 

•  Pole  number  -  not  to  be  confused  with  phases,  poles  are  the  permanent  magnets 
mounted  on  the  stator  of  a  brushed  motor  or  the  rotor  of  a  brushless  motor.  As  with 
phases,  a  larger  number  of  poles  will  tend  to  reduce  the  magnitude  of  the  torque  ripple. 
The  pole  number  affects  the  commutation  by  requiring  the  phases  to  be  switched  more 
rapidly  and/or  interspersed  around  the  motor. 

In  the  end,  the  brushless  technology  was  chosen  primarily  to  eliminate  the  effects  of 
brush  friction  on  output  torque.  The  higher  thermal  time  constant  also  allowed  a  slightly 
smaller  motor  to  be  used  without  fear  of  heating  up  the  coils  to  their  melting  point.  The 
absence  of  electrical  arcing  across  the  brushes  also  make  brushless  motors  preferable  for 
space  operation,  a  probable  application  of  HC4M  technology. 

Once  the  decision  was  made  to  use  a  brushless  motor,  a  choice  had  to  be  made  between 
trapezoidal  or  sine  wave  commutation.  Trapezoidal  commutation  is  far  simpler,  with  the 
stator  coils  being  alternately  energized  vrith  the  full  desired  current.  An  encoder  or  hall 
effect  sensor  is  adequate  for  determining  when  to  switch  the  phases.  Since  the  phases 
ramp  up  and  then  level  out  linearly,  the  magnetic  field  density  varies  as  the  magnets 
rotate,  increasing  the  effect  of  torque  tipple,  and  decreasing  motor  efficiency. 

A  sine  wave  commutation  scheme,  on  the  other  hand,  varies  the  current  to  each  phase 
continuously  as  the  motor  rotates.  An  EPROM  lookup  table  is  used  to  coordinate  the 
resolver  data  with  phase  energization  current.  Theoretically,  perfect  sine  wave  commu- 
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Phase  Current  versus  Position  for  3  Phase  Sine  Wave  Commutation 
Figure  2.4:  Comparision  of  Trapesoidal  and  Sine  Wave  Commutation. 
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tation  would  yield  zero  torque  ripple,  as  the  magnetic  field  density  is  always  constant.  In 
practice,  however,  unbalanced  phase  gains,  offsets,  imperfect  commutation  tables,  geo¬ 
metric  non-linearities  in  the  magnetics,  and  out-of-phase  resolvers  can  cause  substantial 
variations.  Figure  2.4  shows  both  trapezoidal  and  sine  wave  commutation  schemes. 

2.2.2  Sensor  Criteria 

The  majority  of  torque  sensing  configurations  fall  into  three  categories:  reaction,  inline, 
and  joint  mounted.  Each  technique  has  tradeoffs  to  be  considered  for  the  particular 
application. 

Reaction  sensing:  In  a  tjrpical  scheme  using  reaction  torque  sensing,  the  sensor  is 
placed  between  the  actuator  and  ground.  The  output  from  the  actuator  goes  through 
the  transmission  to  the  load,  while  an  equal  and  opposite  reaction  force  acts  upon  the 
sensor.  The  motor  housing  is  mounted  on  bearings  to  isolate  the  sensor  from  tangential 
and  axial  loadings.  The  sensor  is  essentially  a  strain-gauge  instrumented  torsion  beam 
connecting  the  actuator  to  ground. 

A  model  of  a  reaction  torque  sensor  is  shown  in  figure  2.5.  The  simplified  equations 
of  motion  for  this  system  axe: 

Jk  +  J,  0  0]  -2Brn  0 

0  0  -f-  —2Bfn  3Rm  0  9„,  -f- 

.0  0  L  0  0 

K,  0  0  1  r 

0  Kt  -NKt  9^ 

0  -NKt  N^Kt\  [9j 


(2.1) 
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Figure  2.5:  Reaction  Torque  Sensor  -  Lumped  Parameter  Model. 

where  Tm  =  motor  torque  9,  =  sensor  angle  of  rotation 

Tj  =  joint  output  torque  9fn  =  motor  shaft  angle  of  rotation 

Jh  ==  motor  housing  inertia  9t  =  transmission  angle  of  rotation 

J,  =  sensor  inertia  9j  =  joint  angle  of  rotation 

=  rotor/shaft  inertia  B,  =  inner  housing  bearing  friction 

Jj  =  joint /link  inertia  =  shaft  bearing  friction 

K,  =  sensor  compliance  Bj  =  joint  friction 

Kt  =  transmission  compliance 


If  Bn  <.  1*  the  sensed  torque  T,  is  mechanically  decoupled  from  the  last  link,  leaving: 

T,  =  K,9,  =  Tn-  {Jh  +  J,)9\  -  BJ,  (2.2) 
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The  undamped  natural  frequency  between  the  motor  and  the  sensor  is  then: 

K, 


(j)^  = 


(2.3) 


To  find  the  natural  frequency  between  the  motor  and  the  system,  it  is  necessary  to 
reflect  the  joint  inertia  and  friction  into  the  motor  domain.  This  introduces  a  factor  of 
since  all  forces  are  reduced  by  the  ratio  N,  and  9i  =  However,  the  torque  only 
gets  scaled  by  Replacing  this  in  2.1  and  removing  the  decoupled  first  row: 

[ir  t‘] [*:]=[":]  <-) 

To  find  the  undamped  natural  frequency,  take  the  determinant  \K  —  =  0,  and 

solve: 

The  advantages  represented  by  a  reaction  sensor  include  its  compact  size  (less  than  1 
inch  wide)  and  simple  design.  Since  the  sensor  is  fixed  to  ground,  it  has  no  moving  parts, 
and  the  shaft  is  displaced  only  a  fraction  of  a  degree  (0,).  It  exhibits  a  high  stiflTness 
proportional  to  its  load  range.  For  robotic  applications,  the  sensor  would  be  colocated 
with  the  motor,  resulting  in  a  stable  direct  coupled  system.  This  can  be  seen  in  2.2  where 
only  the  stator  and  sensor  friction  and  inertia  terms  affect  the  sensed  torque.  Mounting 
on  the  base  of  manipulator  also  means  that  there  is  less  mass  on  the  outer  links,  resulting 
in  higher  accelerations  and  forces.  The  biggest  disadvantage  with  using  a  reaction  sensor 
is  that  the  sensor  is  coupled  with  the  stator  and  motor  housing.  This  large  mass  (J^) 


CHAPTER  2.  TORQUE  CONTROL  DESIGN  CONSIDERATIONS 


30 


©j 

Tj 


Figure  2.6:  Inline  Torque  Sensor  -  Lumped  Parameter  Model. 

limits  the  bandwidth  of  the  system.  Additionally,  the  torque  deliyered  to  the  joint  is 
not  precisely  known,  since  transmission  friction  and  dynamics  are  between  the  joint  and 
sensor  as  seen  in  figure  2.5. 

Inline  sensing:  The  sensor  is  placed  between  the  rotor  and  the  output  shaft.  The 
most  commonly  used  (and  least  expensive)  type  are  strain-gauge  based  sensors,  where 
an  instrumented  torsion  bar  spins  with  the  motor  velocity.  A  slip  ring  picks  the  torque 
signal  off  of  the  rotating  shaft.  Other  types  of  inline  sensors  include  rotary  transformers, 
torsional  variable  differential  transformers  (TVDT),  and  phase  shift  devices.  These  de¬ 
vices  can  often  produce  accuracies  as  high  as  the  strain  gauge  sensors,  but  exhibit  lower 
noise  rejection  and  poorer  DC  response. 

A  model  of  an  inline  torque  sensor  is  shown  in  figure  2.6.  The  motor /sensor  masses 
and  frictions  and  sensor /transmission  stiffnesses  can  be  lumped  together,  so  the  equations 


CHAPTER  2.  TORQUE  CONTROL  DESIGN  CONSIDERATIONS 


31 


of  motion  for  this  system  reflected  to  the  motor  side  of  the  transxnission  are: 


Jm  Jt  0 

■  »  jk- 


iiliy-® 

(2.6) 


The  undamped  natural  frequency  for  this  system  is  similar  to  that  obtained  in  2.5: 


"  K.  +  K,\J„  +  J.  Jj 


(2.7) 


Since  the  sensor  is  now  located  inline  with  the  transmission,  its  bandwidth  is  now 
limited  by  the  link  natural  frequency.  This  has  also  been  degraded  by  introducing  the 
additional  sensor  compliance  into  the  transmission.  The  effect  of  K,  on  the  bandwidth 
can  be  seen  in  the  stiffness  term  of 

Like  the  reaction  sensor,  an  inline  sensor  can  be  mounted  on  the  base  of  the  manipula¬ 
tor,  keeping  its  mass  away  from  the  endtip.  For  very  stiff  transmissions,  when  Kt'>K„ 
high  bandwidths  can  be  achieved,  perhaps  even  better  than  the  reaction  sensor,  since 
Jm,  <  A-  The  problems  inherent  with  using  an  inline  sensor  include  noise  and  brush 
friction  introduced  through  the  slip  tings  of  a  strain  gauge  system,  and  a  lower  stiffrxess 
than  comparable  reaction  sensors.  The  other  sensor  tjrpes  avoid  the  slip  rings,  but  also 
have  noise  problems  which  limit  their  accuracy.  The  complexity  of  the  sensor  is  higher 
due  to  the  moving  shaft,  and  it  must  be  cleaned  and  lubricated  periodically.  The  pack¬ 
age  size  is  usually  larger  for  a  0ven  torque  range,  since  it  may  also  include  bearings  in 
addition  to  the  sensor  and  slip  rings.  Like  the  reaction  sensor,  the  inline  can  not  observe 
transmission  losses  and  cannot  predict  joint  torques  accurately. 
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Figure  2.7:  Joint  Torque  Sensor  -  Lumped  Parameter  Model. 

Joint  Sensing:  The  torque  sensor  is  placed  between  the  output  side  of  the  trans¬ 
mission  and  the  driven  joint.  Alternatively,  the  joint  itself  can  be  instrumented  if  it  is 
compliant  enough  to  be  used  as  a  sensor.  Figure  2.7  shows  a  model  of  a  joint  sensor. 

When  the  sensor  is  moved  to  the  right  of  the  transmission,  it  is  reflected  back  similar 
to  the  joint  inertia:  A’f(joint)=:  ^(motor)  The  equations  of  motion  are  modified  to  be: 


Jm 

0 


with  a  natural  frequency  of: 


"  K.  +  N^K,{j^^  Ji  +  jJ 


(2.9) 
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It  can  be  seen  from  the  model  that  the  bandwidth  limitation  ii  itill  the  natural 
frequency  of  the  tranimisaion  path.  This  bandwidth  is  d^aded  even  more  than  the 
inline  model,  since  the  sensor  compliance  is  reflected  through  the  reduction.  This  results 
in  the  term  in  the  denominator  of  the  stiffness  term. 

The  greatest  advantage  obtained  by  placing  the  sensor  at  the  joint  is  that  it  registers 
the  actual  joint  torque,  including  transmission  losses.  This  is  the  most  accurate  way 
to  measure  joint  torques,  but  also  has  its  disadvantages.  The  sensor  must  be  motmted 
directly  to  the  joint,  necessitating  a  larger  structure  with  increased  mass.  All  motors 
and  structures  further  back  in  the  kinematic  chain  must  then  be  sised  for  this  greater 
mass.  All  power  and  signal  cables  would  need  to  run  through  the  links,  increasing  joint 
design  complexity  and  maintenance  difficulty.  From  the  control  perspective,  stability  at 
high  gains  will  be  difficult  to  achieve  and  limit  cycling  may  occur  since  the  transmission 
djmamics  are  between  the  actuator  and  sensor. 

Endpoint  mounted  force/ torque  sensors  have  similar  characteristics  to  the  joint  sen¬ 
sor.  By  coming  into  direct  contact  with  the  work,  they  provide  very  accurate  and  high 
bandwidth  information  about  the  actual  forces  exerted  by  the  arm.  Unfortunatdy,  since 
the  sensor  is  located  after  the  transmission  and  links  j  the  manipulator  dynamics  make 
it  very  difficult  to  close  a  stable  control  loop  about  this  force.  The  bandwidth  of  this 
controller  is  therefore  limited  by  the  natural  frequency  of  the  arm.  In  very  stiff,  low 
inertia  medianisms  the  upper  frequency  bound  is  on  the  order  of  50  Hz,  and  can  fall  as 
low  as  1  or  2  Hz  for  very  flexible  structures. 

After  comparing  the  advantages  of  each  sensor  class,  it  was  decided  to  use  a  reaction 
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torque  sencor.  The  primary  reason  for  its  selection  is  that,  for  relatively  compliant  trans¬ 
missions  (such  as  found  in  the  WAAf)^  the  reaction  torque  sensor  provides  the  highest 
motor  •  sensor  bandwidth.  High  bandwidth  is  far  more  important  in  Wh^e  Arm  Ma- 
nipxilaiion  applications  than  accurate  joint  torque  control,  due  to  the  stiffness  control 
scheme  utilized.  In  this  controller,  the  torque  is  computed  from  the  position  error  scaled 
by  a  stiffriess  gain  matrix.  Since  the  transmission  is  greater  than  95%  efficient,  the  motor 
torque  is  a  very  accurate  representation  of  the  actual  joint  torque.  We  felt  it  was  far 
more  important  to  improve  the  accuracy  of  the  torque  generated  by  the  motor,  since 
all  torque  errors  would  be  scaled  by  N  at  the  joint.  This  required  the  high  bandwidth 
obtainable  only  with  the  reaction  sensor.  Additionally,  the  insertion  of  either  an  inline 
or  joint  sensor  between  the  motor  and  joint  would  add  more  compliance,  thus  degrading 
the  position  bandwidth. 

The  reaction  torque  sensor  is  also  the  smallest  of  all  the  devices.  It  can  be  located 
inside  the  actuator,  producing  a  clean  compact  package  that  can  be  mounted  to  the  base 
of  the  manipulator.  This  would  also  eliminate  routing  additional  signal  wires  through 
the  arm,  simplifying  assembly  and  maintenance. 


Chapter  3 
Design 

3.1  Hardware  Design 

Theie  are  three  main  components  to  this  system:  the  actnator  package,  drive  electronics, 
and  torque  controller.  The  following  sections  will  briefly  describe  the  design  and  capabil¬ 
ities  of  these  modules.  Appendix  A  contains  the  machined  parts  drawings,  and  appendix 
B  includes  data  sheets  for  the  actual  components. 

3.1.1  Actuator 

The  actuator  mechanism  consists  of  a  frameless  torque  motor,  modular  resolver,  and 
reaction  torque  sensor,  as  seen  in  figure  3.1.  As  explained  in  chapter  3,  the  motor  is  a 
three-phase  brushless  DC  motor,  with  rare-earth  magnets  for  high,  flux  density.  Baseline 
design  requirements  include  a  continuous  torque  of  15  in-lb  at  a  speed  of  2500  rpm.  HHK 
Industries  has  customized  a  motor  to  meet  these  requirements. 

The  resulting  motor  has  a  diameter  of  2.5  inches  and  stack  length  of  2.5  inches.  Unlike 
most  brushless  motors,  this  model  is  ‘slotless’.  Instead  of  wrapping  the  coils  around  an 
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iron  core  to  concentrate  the  magnetic  field,  the  itator  is  filled  completely  with  wire. 
Flux  density  is  higher  despite  an  airgap  that  is  much  larger  than  found  in  conventional 
motors.  The  extra  room  for  windings  allows  larger  coils  to  be  used,  resulting  in  lower 
copper  losses  and  a  higher  thermal  time  constant.  The  motor  inductance  is  also  much 
lower  than  that  of  motors  containing  toothed-type  stators.  Iron  losses  and  cogging  aire 
common  in  conventional  motors  and  result  from  the  changing  reluctance  in  the  magnetic 
paths  between  various  points  on  the  magnets  and  stator.  The  reluctance  is  much  lower 
in  the  magnetic  paths  between  the  magnets  and  the  teeth  than  in  the  paths  between 
the  magnets  and  the  stator  through  the  slot  openings.  Another  characteristic  of  toothed 
motors  is  a  varying  flux  levd  in  the  teeth  as  the  motor  rotates.  This  varying  flux  can 
cause  hysteresis  and  eddy  current  losses,  which  may  account  for  more  than  half  of  the 
losses  in  a  conventional  brushless  motor.  The  resulting  efficiency  from  this  motor  is 
significantly  higher  than  that  of  a  comparable  slotted  motor.  Cogging  is  also  virtually 
eliminated. 

The  rotor  is  composed  of  six  rare-earth  magnetic  poles  arranged  hexagonally  on  a 
stainless  steel  insert.  The  inner  diameter  of  the  rotor  contains  a  keyway  for  mating  to 
the  shaft.  Unfortunately,  keys  permit  a  small  amount  of  misalignment  and  backlash, 
and  were  therefore  unacceptable  in  this  design.  The  solution  was  to  knurl  the  shaft  to 
a  slightly  larger  dimension  than  the  the  rotor  inner  diameter.  This  shaft  could  then  be 
press  fit  into  the  rotor  with  the  knurled  section  providing  more  compliance  than  the  solid 
shaft.  This  method  assured  concentricity  and  avoided  backlash  completely. 

The  motor  housing  is  essentially  a  thin  walled  aluminum  cup  with  a  precision  instru- 
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Figoze  3.1:  Actuator  layout. 
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ment  bearing  centered  on  its  bottom.  The  stator  assembly  was  first  given  a  coating  of 
thermal  grease  and  then  slid  in  until  the  laminations  made  contact  with  a  small  shelf. 
A  silicon  rubber  adhesive  sealant  was  used  to  bond  the  stator  to  the  housing.  A  thin 
bearing  plate  was  mated  with  the  open  end  of  the  motor  housing,  and  aligned  with  two 
slots.  Pins  were  inserted  through  these  slots  into  the  plate  to  keep  it  from  moving  relative 
to  the  housing. 

A  modular  resolver  is  attached  to  this  housing  on  the  output  end,  with  the  shaft 
running  through  its  center.  This  resolver  is  a  single  speed  transmitter  model  produced 
by  Clifton  Precision.  Its  brushless  design  minimises  friction  while  providing  an  accuracy 
of  15  arc  minutes.  Encoders  were  investigated  as  an  alternative,  but  could  not  be  used 
by  the  motor  controller  for  sine  wave  commutation.  Servo  mount  cleats  were  used  to 
attach  the  resolver  to  the  plate  and  enable  accurate  phase  adjustment.  Precision  shaft 
spacers  were  inserted  on  both  sides  of  the  resolver  rotor  to  properly  position  and  preload 
the  shaft  against  the  housing  bearings. 

The  motor  housing  is  suspended  inside  the  outer  housing  by  two  bearings.  A  Kaydon 
Reali-Slim  bearing  is  press  fit  onto  the  back  of  the  cup,  and  rests  on  a  flange  in  the 
outer  housing.  The  other  bearing  is  mounted  on  the  shaft  at  the  prnnt  where  it  exits 
the  housing.  The  bulkhead  containing  this  bearing  required  a  special  design,  since  the 
thin  housing  walls  did  not  permit  axial  screws.  As  this  was  also  the  mounting  surface,  it 
needed  to  be  a  strong,  reliable  connection.  The  design  required  that  a  groove  be  cut  into 
the  inside  of  the  housing.  An  internal  snap-ring  flt  in  this  groove  and  retained  a  plate. 
The  bulkhead  was  then  screwed  into  this  plate  and  tightened  against  the  snap-ring.  This 
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arrangement  provided  a  very  ctrong,  positive  connection. 

Mounted  to  the  back  motor  end  plate  is  the  input  shaft  of  a  reaction  torque  sensor. 
This  strain  gauge  based  sensor  is  made  by  Sensotec  and  boasts  a  range  of  50  in-lbs  with 
linearity  to  0.1%.  Deflection  at  full  load  is  less  than  0.25  degrees  of  arc.  The  sensor  itself 
is  mounted  to  the  rear  bulkhead  of  the  outer  housing  by  six  screws.  The  motor  housing 
is  mated  to  the  sensor  input  shaft  by  a  collet  and  compression  clamp.  This  coupling 
is  preferred  over  the  traditional  set  screws  because  it  eliminates  backlash  and  does  not 
cause  surface  stresses  on  the  shaft.  Since  the  motor  housing  is  supported  by  the  Kay  don 
and  shaft  bearing,  the  torque  sensor  is  eflectively  isolated  from  radial  and  axial  loading. 

The  operating  concept  of  the  torque  sensor  is  essentially  a  torsion  bar  instrumented 
with  strain  gauges.  Due  to  the  very  low  output  voltages  from  strain  gauges  (on  the 
order  of  millivolts),  it  is  necessary  to  mount  an  instrumentation  amplifier  and  low  pass 
filter  assembly  near  to  the  motor  housing.  The  amplifier  and  filter  raise  the  signal  to 
noise  ratio,  and  hence  improve  torque  resolution.  An  Analog  Devices  5931B  Strain 
Gauge  Signal  Conditioner,  a  28  pin  DIP,  was  used.  It  contains  a  full  bridge  strain  gauge 
instrumentation  amplifier  and  second  order  low  pass  filter.  The  cutoff  frequency  of  the 
filter  can  be  adjusted  from  10  Hs  to  20kHz.  This  circuit  and  compensating  resistors  and 
capacitors  are  mounted  in  a  shielded  metal  box  in  close  proximity  to  the  torque  sensor. 

3.1.2  Drive  Electronics 

The  incorporation  of  a  strain  gauge  based  torque  sensor  into  the  actuator  package  places 
severe  constraints  on  the  motor  drive  electronics.  The  amplifier  output  should  be  virtually 
DC,  as  high  frequency  noise  would  corrupt  the  millivolt  strain  gauge  signals.  Unfortu- 
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nately,  most  pulse  width  modulated  amplifiers  radiate  voltage  spikes  at  their  switching 
frequency.  The  drivers  used  in  the  current  WAM  system  produce  up  to  12  volt  2  MHz 
spikes  every  0.2  msec,  which  can  be  detected  virtually  anywhere  in  the  lab.  This  noise  is 
certainly  large  enough  to  trip  TTL  logic,  and  would  easily  eradicate  a  low  voltage  torque 
signal. 

There  were  two  possible  solutions  to  this  problem.  The  first  was  to  find  or  design  a 
linear  amplifier  capable  of  driving  the  chosen  motor.  This  would  eliminate  high  frequency 
noise  at  the  source,  since  there  is  no  switching  component.  Unfortunately,  there  are  not 
many  linear  amplifiers  capable  of  driving  a  3  kilowatt  load,  and  even  fewer  are  configured 
for  brushless  motors,  as  this  would  require  three  individual  linear  power  stages.  In 
general,  linear  amplifiers  are  not  used  very  frequently  because  they  need  to  be  much 
larger  than  comparable  PWM  amps,  and  are  much  less  efficient,  dissipating  the  losses  as 
heat. 

The  other  possibility  for  a  low  noise  high  power  servo  amplifier  was  to  go  with  a 
PWM  design  that  uses  low  pass  filters  on  the  output  stage.  These  amplifiers  meet 
military  specifications  for  EMI/RFI,  and  consequently  are  about  twice  as  expensive  as 
other  brushless  amplifiers.  Unfortunately,  the  only  company  producing  these  hCl-spec 
amplifiers  does  not  yet  have  a  version  for  sine  wave  commutation. 

Faced  with  these  conflicting  constraints,  the  only  alternative  was  to  attempt  to  min¬ 
imize  the  switching  noise.  This  was  accomplished  by  boosting  the  PWM  frequency  to 
16  kHz,  using  sine  wave  commutation,  and  heavily  shielding  the  motor  and  cabling.  It 
was  left  to  the  instrumentation  amplifier  to  filter  and  increase  the  signal  to  noise  ratio 
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Figure  3.2:  Functional  Layout  of  a  Brushleat  Motor  Controller. 

to  a  point  where  the  remaining  noise  would  be  insignificant.  Final  filtering  and  noise 
rejection  was  also  implemented  in  software. 

The  drive  electronics  selected  for  this  actuator  are  made  by  Infranor.  Figure  3.2 
shows  a  functional  block  diagram  of  the  motor  control  dectronics.  An  internal  resolver 
to  digital  convertor  interprets  the  resolver  output  as  shaft  position  with  a  resolution  of  12 
bits.  A  sine  wave  commutation  table  translates  this  position  into  the  correct  current  for 
each  phase.  A  current  loop  is  closed  around  each  phase  to  improve  torque  accuracy.  The 
analog  input  range  extends  to  ±  10  volts,  with  full  scale  produdng  10  in-lb  of  torque. 
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3.2  Development  System 

The  motor  controller  reads  and  processes  all  inputs,  closes  the  low  level  torque  loop, 
and  outputs  motor  commands  and  position/ velocity  data.  For  initial  development,  the 
Condor  multiprocessor  system  was  used  to  provide  the  necessary  hardware  and  software 
interface.  Eventually,  each  actuator  will  be  driven  through  its  own  control  module,  freeing 
up  the  Condor  for  higher  level  tasks. 

The  inputs  to  the  controller  include  the  commanded  torque,  resolver  data,  and  the 
torque  sensor  signals.  Optional  inputs  include  motor  temperature  and  current.  The 
input  processing  includes  analog  to  digital  conversion,  signal  filtering,  position  tracking, 
and  velocity  calculations. 

3.2.1  Condor  Hardware 

The  control  implementation  for  the  actuator  shares  the  Condor  environment  of  the  MIT- 
WAM.  This  system  consists  of  five  Ironies  3201  single-board  computers,  an  Ironies  3273 
Bus  Controller,  a  Data  Translation  1401  analog-to-digital  converter,  a  Data  TransUr 
tion  1406  digital-to-analog  converter,  and  two  Motorola  MVME-340  parallel  ports.  This 
hardware  is  housed  in  a  VME-Bus  card  a^(e,  and  interfaced  to  a  SUN-3/280  workstation 
through  a  EVE- 2000  VME  bus-to-bus  adapter.  The  Sun  is  used  for  program  development 
and  for  analysing  data  stored  on  the  processors. 

The  computation  in  each  Ironies  3201  is  performed  by  a  Motorola  68020  micropro¬ 
cessor  with  a  68881  floating  point  accelerator.  One  mq^abyte  of  dual-ported  RAM  is 
contained  on  each  board,  and  can  be  accessed  by  the  local  CPU  or  across  the  VME  bus. 
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The  bus  controllet  provides  interrupt  management,  bus  arbitration,  and  reset  functions. 
The  DT  1406  D/A  board  provides  eight  12  bit  digitial'to-analog  converters  which  are 
used  to  transmit  commands  to  the  motor  controllers.  The  DT  1401  A/D  has  32  single- 
ended  analog-to-digital  converters  with  12-bits  of  resolution  and  programmable  gains. 
The  Motorola  parallel-port  boards  read  the  digital  position  signals  from  the  motor  con¬ 
trollers  without  handshaking,  and  can  be  configured  for  interrupts.  Optical  isolation  is 
provided  between  the  amplifier  and  the  DIO  board  to  eliminate  the  electromagnetic  noise 
radiated  by  the  pulse  width  modulation.  The  HVE  bus  connector  links  the  Sun  directly 
to  the  VME  bus,  allowing  it  to  access  the  dual  ported  RAM  on  the  processors. 

Since  the  system  is  only  required  to  control  a  single  aids,  it  was  possible  to  achieve 
sufficient  computational  speed  using  just  one  of  the  five  processor  boards.  This  board 
acts  as  the  input/output  processor  and  closes  all  of  the  control  loops.  The  A/D  board 
provides  feedback  from  the  torque  sensor.  One  of  the  parallel  boards  is  used  to  read 
position  data,  and  motor  commands  are  issued  through  the  D/A  board. 

3.2.2  Condor  Software  Support 

The  Condor  system  software  provides  many  useful  features  for  real  time  control.  Some  of 
the  embedded  functions  consist  of  device  drivers  for  the  hardware  components,  a  mailbox 
system  for  meuage  passing,  basic  UNIX  functions,  debugging  support,  a  virtual  terminal 
for  each  processor,  and  a  large  number  of  user  utilities. 

The  Sun  provides  the  programming  and  interface  environment  for  the  Condor  system. 
Since  both  the  Sun  and  the  Ironies  processors  are  based  on  the  68020,  the  standard 
C  compiler  can  be  used.  For  large  tasks,  the  control  code  can  be  split  into  separate 
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Figure  3.3:  MTT-WAM  Control  Hardware  Block  Diagram 
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programs,  each  running  on  its  own  processor.  A  real-time  library  containing  UNIX 
functions  and  software  utilities  is  linked  to  each  routine.  These  control  programs  can 
then  be  downloaded  to  the  microprocessors  over  the  bus  to  bus  connector.  A  virtual 
terminal  connects  each  of  the  processors  to  the  Sun  so  that  each  board  has  a  window 
on  the  workstation.  Additionally,  the  Sun  has  access  to  the  dual-ported  RAM  on  each 
processor.  There  is  also  a  software  mailbox  system  allowing  the  processors  to  pass  data 
among  themselves. 

Some  of  the  utilities  offered  by  the  Condor  environment  include  device  drivers  for  all 
of  the  input /output  boards.  There  are  also  special  purpose  routines  developed  iot  servo 
implementation.  The  system  is  capable  of  looping  through  a  user  defined  routine  at  a 
specified  servo  rate.  Interrupts  and  error  handlers  can  be  defined  to  kick  out  of  the  loop, 
or  execute  a  different  routine.  This  esy^es  the  programming  task  by  embedding  the  timing 
and  interrupt  code  in  the  operating  environment. 

3.3  Software  Implementation 

Although  the  Condor  system  is  capable  of  supporting  five  processor  boards,  only  one  was 
required  to  achieve  the  desired  loop  speed.  This  single  processor  performed  all  functions 
from  input  processing  through  motor  commands.  A  command  menu  was  provided  to 
execute  individual  processes  for  debugging  and  evaluation  purposes.  Print  and  write 
routines  were  available  fDt  data  collection.  Switches  were  provided  to  select  and  enable 
the  control  algorithms.  A  significant  amotint  of  the  software  was  adapted  from  the  WAM 
operating  system  [Eberman  89a][Niemeyer  89]  so  that  the  controller  would  be  compatible 
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for  direct  motor  substitution.  Brief  descriptions  of  some  of  the  software  routines  follow. 

A  substantiskl  portion  of  the  code  is  dedicated  to  input  processing.  These  routines 
read  the  parallel  port  to  obtain  a  digital  representation  of  the  resolver  position.  Absolute 
position  is  maintained  by  counting  motor  revolutions.  These  position  values  are  filtered  to 
remove  any  spurious  points  catued  by  motor  noise  or  conversion  errors.  Since  the  Condor 
system  does  not  take  advantage  of  the  converter  busy  signal  due  to  noise  problems,  errors 
can  be  introduced  by  reading  the  parallel  port  in  the  midst  of  the  conversion.  The  filtering 
method  compares  the  last  two  points  with  the  new  input,  and  takes  the  median  value  as 
the  new  point.  The  velocity  is  then  computed  using  a  first  order  difference  and  passed 
through  another  filter.  Both  the  position  and  vdodty  values  are  stored  in  local  RAM. 

Other  inputs  that  require  processing  indude  the  sensed  torque.  This  value  is  collected 
through  the  A/D  convertor,  and  then  converted  to  usable  units  using  scaled  gains  and 
offsets.  This  value  is  also  similarly  filtered  to  eliminate  noise. 

Output  processing  consists  of  converting  the  torque  spedfied  by  the  control  loop  into 
D/A  units  and  sending  it  to  the  DT1406. 

A  main  control  menu  is  induded  in  the  software.  This  menu  enables  the  user  to  sdect 
a  control  loop,  vary  the  gains,  and  adjust  the  servo  frequency.  Other  options  indude 
data  collection  and  display,  input/outpnt  test  routines,  and  status  reports.  Torque  and 
position  commands  can  also  be  specified  through  menu  driven  input  routines.  The  user 
can  select  torque  or  position,  magnitude,  and  the  duration  of  the  move/torque.  A  model 
of  the  controller  will  be  discussed  in  detail  in  chapter  4. 

Although  the  prototype  system  was  implemented  on  a  single  processor  in  the  Condor 
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environment,  it  required  %  fubtt&ntial  amount  of  computational  power.  For  a  full  WAM 
implementation  of  four  torque  controlled  actuators,  separate  controller  modules  would 
be  required  for  each  motor.  Each  module  would  consist  of  a  microprocessor,  dual-port 
dynamic  RAM,  and  all  necessary  I/O  hardware.  The  processor  has  not  been  determined, 
but  will  likely  be  either  a  standard  16  bit  design  or  a  digital  signal  processing  chip. 
Both  options  will  be  explored  before  a  decision  is  reached.  The  memory  unit  should  be 
dual-ported  to  allow  adaptive  gain  changes  and  access  by  the  supervisory  controller.  All 
communications  with  the  host  will  be  accomplished  through  a  parallel  link  to  provide 
high  speed  data  transmission.  This  type  of  control  module  would  relieve  the  C!ondor 
system  of  the  computational  burden  of  performing  the  I/O  processing  and  closing  the 
low  level  torque  loops.  If  a  DSP  were  used,  each  module  would  be  capable  of  closing  a  a 
full  impedance  controller  and  performing  additional  1/0  tasks. 


Chapter  4 
System  Model 


This  chapter  will  derive  the  models  for  the  various  components  that  make  up  the  actuator. 
Disturbances  such  as  torque  ripple  and  friction  will  be  studied.  The  bandwidth  of  each 
component  and  the  entire  system  will  be  estimated. 

4.1  Motor  Model 


A  model  of  the  basic  stator  circuit  equivalent  for  a  permanent  magnet  brushless  motor 
is  shown  in  figure  4.1.  This  is  a  linearized  model  of  the  current  in  a  frame  rotating 
with  the  motor.  This  allows  the  stator  to  be  modeled  as  an  average  phase  inductance 
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Figure  4.1:  Stator  Equivalent  Circuit. 
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and  phase  lesistaace.  In  reality,  the  inductance  will  vary  as  the  motor  rotates  and  with 
motor  current,  and  will  also  include  mutual  inductance  from  the  other  windings.  A  source 
voltage  Va  drives  a  current  i  through  this  stator  winding  which  develops  a  torque  on  the 
rotor.  The  inductance  and  resistance  of  the  windings  cause  a  voltage  drop  across  the 
coils.  If  the  rotor  is  free  to  rotate,  it  will  accelerate  to  some  speed  at  which  its  counter- 
emf  is  approximately  equal  to  the  applied  voltage  after  the  drop.  This  counter-emf 
generated  in  the  stator  windings  opposes  the  applied  voltage  and  balances  the  electrical 
and  mechanical  power.  It  is  proportional  to  speed  w  by  the  constant  JC,.  Equation  4.1 
shows  the  effects  of  the  inductance,  resistance,  and  counter-emf  on  the  applied  voltage. 

K^L^  +  Ri-hK^  (4.1) 

Multiplying  the  above  equation  by  i  yields  the  power  in  the  system. 

p  =  v.<  =  ii;l(i')  +  JU»  +  jr.M  (4.2) 

The  first  and  second  terms  in  equation  4.2  are  the  power  stored  in  the  inductance  and 
dissipated  by  the  resistance,  respectively.  The  final  term  is  the  power  that  is  converted 
into  mechanical  energy.  From  conservation  of  energy,  K, ,  the  back  EMF  constant,  and  Aft, 
the  torque  constant,  axe  equal,  although  they  have  different  units.  Taking  the  derivative 
of  motor  power,  Pf^,  with  respect  to  ur  yields  the  torque: 

Pm  =  TmW  =  K,un  (4.3) 
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=  r«  =  K,i  =  Kti  (4.4) 

For  a  cteady  >tate  ctirrent,  the  inductance  term  kai  no  effect.  Neglecting  the  in¬ 
ductance  and  substituting  4.4  back  into  4.1  yields  a  relationship  between  torque  and 
speed. 


T„  =  ^(V.  -  K.w) 


(4.5) 


By  setting  the  torque  to  sero  the  ^no-load”  speed  can  be  computed. 


u>o  =  TT  Tad/ see 

Rt 


(4.6) 


Since  motors  often  operate  over  a  wide  range  of  torques  and  speeds,  it  is  difficult  to 
define  an  appropriate  measure  of  efficiency.  The  motor  constant  Kf^  gives  a  means  of 
comparing  motor  efficiency  independent  of  torque  and  speed. 


y/FZ  Tpx  'Tr 


(4.7) 


Substituting  the  motor  constant  into  the  torque  -  speed  rdationship  then  fpves: 


-  u;) 


(4.8) 


This  linear  torque  •  speed  relationship  can  be  seen  in  figure  4.1.  This  is  known  as  a 
torque-speed  curve  and  has  a  slope  of  constant  —K^  with  stall  torque  Tt  = 
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The  resultant  power  loss  due  to  copper  heating  is  then 

=  BOit.  (4.9) 

The  acceleration  of  the  motor  shaft  can  be  estimated  by  modeling  it  as  a  simple 
inertial  load  with  bearing  friction  B„.  This  load  would  then  accelerate  according  to: 

Solving  for  u>  above,  taking  the  Laplace  transform,  and  combining  with  the  Laplace 
transform  of  4.1  leaves 


Vi  =  (Xs  +  R)i  + 


KKti 

Jm*  +  Brn 


(4.11) 
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The  curtent  control  amplifier  stabilizes  the  applied  motor  voltage  according  to  the 
control  law: 


V.  =  -  0  (4.12) 

where  Ke  iz  the  gain  on  the  current  loop,  and  is  a  scale  factor  relating  the  actual 
current  to  the  current  command  given  in  volts.  Substituting  in  the  term  for  V,  found  in 
4.11  gives  the  transfer  function  from  commanded  voltage  to  current 


i^_K^ _ «  +  _ 

Ve(s)  L  ^ 

Since  Tm  =  Hti,  the  open  loop  transfer  function  is  then 


(4.13) 


G(s)  = 


T^  K,K,K, 


4-  5* 

. — 


(4.14) 


It  is  evident  from  this  transfer  function  that  the  motor  is  a  second  order  system,  with 
a  zero  and  two  poles.  The  zero  will  be  very  close  to  the  imaginary  axis  since  the  damping 
term  ,  ^,  is  very  small  due  to  bearing  friction.  The  poles  are  less  easily  identified. 
In  order  to  close  a  tigh^  current  loop,  the  current  gain,  is  made  very  large.  This 
causes  the  system  to  be  overdamped,  and  drives  the  poles  apart.  The  high  frequency 
pole  moves  so  far  down  the  real  axis  that  it  has  little  effect  on  the  system.  The  other 
pole,  however,  is  driven  towards  the  origin  and  the  system  zero.  Ideally  the  pole  and  zero 
would  coincide  and  cancel,  but  the  changing  damping  and  inertia  in  the  system  cause 
the  zero  to  move.  This  pole-zero  pair  is  virtually  hidden  in  a  low  resolution  frequency 
response  of  the  system,  but  becomes  evident  when  it  dominates  the  time  response. 
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4.2  Sensor  Model 

The  equation*  of  motion  for  the  motor  /  tensor  pair  were  derived  in  chapter  2.  Referring 
to  equation  2.2 

T,  =  K,0»  =  -  (Jk  +  J»)0,  -  Bj,  (4.15) 

There  is  a  proportional  relationship  between  the  feedback  voltage  from  the  strain 
gauge  amplifier,  V/  and  the  rotation  of  the  sensor  shaft: 

Vf  =  KJ,  (4.16) 

The  sensor  transfer  function  can  then  be  derived: 


-  (A  +  A)(.>  +  ^.  +  :^) 

Since  the  sensor  is  couple  directly  to  the  motor  stator  and  housing  rather  than  the 
rotor,  the  inertia  term,  Jk  +  7«,  is  the  stator  and  housing  inertia,  and  the  damping  term, 
Bf,  is  the  friction  between  the  stator  and  ground. 

This  transfer  function  is  a  classic  second  order  system.  It  has  two  poles  at  the  natural 
frequency  of  And  a  very  low  damping  ratio  due  to  the  low  bearing  friction. 


4.3  Controller  Model 

The  controller  was  relatively  simple  to  implement,  due  to  the  system  design.  Since 
the  PWM  motor  driver  converted  a  voltage  command  to  torque  and  the  torque  sensor 
transformed  torque  back  into  volts,  all  torque  values  in  the  controller  were  represented 
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Figure  4.3:  High  Level  Control  Block  Diagram. 


as  voltages.  The  motor  amplifier  was  tuned  so  that  a  voltage  command  of  ±  10  volts 
corresponded  to  an  open  loop  torque  of  ±  10  in-lbs.  The  gains  on  the  strain  gauge 
conditioner  were  then  modified  so  that  a  sensed  torque  of  ±  10  in-lbs  produced  an  output 
of  ±  10  volts.  This  made  interfacing  and  data  conversion  trivial.  A  block  diagram  showing 
the  system  components  can  be  seen  in  figure  4.3. 

In  this  figure,  Vi  is  the  desired  torque,  V,  is  the  torque  error,  K  i>  the  commanded 
torque  from  the  controller,  i«  the  current  from  the  amplifier,  T^  is  the  motor  torque, 
V,  is  the  sensed  torque,  and  V)  is  the  torque  fed  back  to  the  controller. 

The  standard  Proportional  -f-  Integral  -}-  Derivative  controller  is: 

Kis)  =  ^V.(s)  =  K,  +  ^  +  Ki3  (4.18) 

with 

V,  =  Vi-  Vf  (4.19) 

To  increase  the  response  time,  the  open  loop  torque  command  V4  is  fed  forward 
through  the  controller.  This  allows  the  controller  to  simply  zero  the  error  between  the 
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open-loop  torque  and  the  desired  torques,  rather  than  start  at  the  previous  torque  com¬ 
mand  and  move  to  the  new  command. 

Combining  this  with  the  sensor  transfer  function,  H(s),  and  the  motor  transfer  func¬ 
tion,  G(s)  3rields  the  closed  loop  transfer  function: 

rt.)  -  Z=W  -  (*^(«)  -I-  l)g(«) 

Ki(.)  iir(.)G(j)H(.)  + 1 

Notice  that  the  numerator  contains  a  (K(s)  -(-  1)  term.  For  small  gains  or  high 
frequencies,  the  system  will  respond  like  the  open-loop  system.  The  controller  then  only 
needs  to  correct  for  the  errors  between  open-loop  and  desired  torque.  To  achieve  a  faster 
response,  the  gain  term  can  be  increased,  dominating  the  open-loop  response.  The  higher 
gain  on  this  controller  will  make  it  less  stable,  possibly  resulting  in  oscillations  and  limit 
cycles. 
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4.4  Bandwidth  Estimation 

This  section  will  provide  estimates  of  the  bandwidth  for  the  motor  and  sensor.  The 
values  used  for  these  computations  are  the  manufacturers*  specifications. 

Motor  Parameters 


Model 

Continuous  Stall  Torque 
Maximum  Speed 
Torque  Constant 
Back  EMF  Constant 
Phase  Inductance 
Phase  Resistance 
Rotor  Inertia 

from  these  values  were  obtained: 
Motor  Constant 
Electrical  Time  Constant 
Mechanical  Time  Constant 
Sensor  Parameters 
Model 

Torque  Range 
Deflection  at  Tmaa 
Stiffness 


HHK  0250N013A0A 


Tc  = 

15 

tn  —  lb 

Wo  = 

10,000 

rpm 

2.5 

in— lb!  amp 

K,^ 

30.0 

V/krpm 

X  = 

0.93 

mH 

2.70 

ohms 

11 

.001125 

in—lb—se<^ 

ifm  = 

1.52 

in—lbfy/watts 

r,  = 

0.344 

msecs 

3.00 

msecs 

Sensotec  QWLC-8M 
Tmam  =50.0  W  —  lb 


<f>  =  0.25  degrees 

Kg—  11,500  in  —  lb/rad 
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Linearity 


0.1  percent 


Using  the  timple  motor-fenior  model  developed  in  chapter  2  to  determine  the  tensor 
natural  frequency: 


The  inertia  of  the  motor  housing  and  stator  was  estimated  to  be  0.005  in—lb—sec^, 
giving  a  natural  frequency  prediction  of  1516  rad/tec,  or  about  240  Hs.  If  the  100  in— lb 
version  of  the  torque  transducer  was  chosen,  the  potential  bandwidth  would  be  increased 
to  greater  than  340  He,  but  would  sacrifice  torque  resolution. 

The  open  loop  bandwidth  of  the  motor  can  be  easily  calculated  from  the  electrical 
and  mechanical  time  constants.  The  formula  to  determine  the  motor  bandwidth  without 
a  current  controller  is: 


(4.22) 


Substituting  in  the  motor  time  constants  determined  above,  the  natural  frequency  of 
the  motor  is  estimated  to  about  156  Hs.  Since  the  sensor  bandwidth  is  higher  than  the 
motor  bandwidth,  the  addition  of  the  sensor  does  not  degrade  performance  appreciably. 
Unfortunately,  the  bandwidth  of  the  system  may  be  significantly  reduced  by  the  controller 
and  amplifier.  Related  research  with  the  WAM  motors  has  shown  that  the  measured 
controllable  motor  bandwidth  is  on  the  order  of  10  Hz,  even  though  the  motor  bandwidth 
is  greater  than  100  Hz.  This  discrepancy  is  due  to  the  high  current  gain  inside  the  motor 
controller,  as  described  above  in  the  motor  model.  To  achieve  a  very  tight  current  loop, 
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the  current  gain  is  made  very  large,  which  then  increases  the  motor  damping  and  slows 
the  response.  Plots  showing  the  dynamic  characteristics  of  the  system  can  be  found  in 
chapter  5. 

4.5  Torque  Ripple 

There  are  many  different  factors  leading  to  the  existence  of  torque  ripple.  Stator  slots 
can  cause  variations  in  the  the  air  gap  reluctance  which  leads  to  cogging  torque.  The 
saturation  of  the  iron  laminations  in  the  magnetic  circuit  or  degradation  of  the  magnetic 
flux  due  to  temperature  dependence  of  the  magnets  may  also  contribute  to  ripple.  A 
poorly  designed  or  modeled  controller  may  introduce  some  nonlinearities  and  higher  order 
harmonics  to  the  system.  Offsets  and  gain  differences  in  the  controller  often  produce  a 
majority  of  the  low  order  ripple  harmonics.  PWM  ampliflers  typically  have  a  deadband 
which  can  impose  such  an  offset.  Ripple  may  also  occur  when  there  is  nonsymmetric 
demagnetization  of  the  rotor  magnets  due  to  armature  reaction. 

This  section  will  derive  and  discuss  the  major  contributors  of  torque  ripple  foi  this 
system.  Predictions  of  these  effects  will  be  illustrated.  Actual  plots  of  the  motor  ripple 
can  be  seen  in  chapter  5.  To  understand  the  effects  of  ripple,  the  standard  motor  equa¬ 
tions  derived  earlier  in  this  chapter  must  be  modified  for  this  particular  system.  In  a 
three  phase  motor  such  as  used  in  this  research,  equation  4.4  can  be  written  to  include 
the  contribution  of  each  phase  to  the  total  current: 

Tm  =  Kt  [ia,coa{n6)  +  ikC08{n9  +  120“)  +  icC08{n9  —  120®)]  (4.23) 
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where  n  if  the  number  of  motor  polet  nnd  0  if  the  mechanical  angle  of  the  motor 
fhaft.  Given  the  3>phafe  wye  connection  of  the  ftator,  ««  if  oonftrained  by  Kirchoif’s 
oirrent  law  to  be: 

»«  =  -(t.  +  H)  (4.24) 

Bafed  on  the  finufoidal  commutation  difcuffed  in  chapter  2  and  feen  in  figure  2.4, 
the  firft  order  approximation  for  the  current  in  each  phafe  if: 


=  t  eos{n0) 

H  =  »cof(nd  + 120")  (4.25) 


with  te  being  determined  by  the  other  two  phajea.  The  computed  theoretical  torque 
for  the  above  conatrainta  if  now 


(4.26) 


(Notice  that  thia  expreaaion  differa  &om  the  one  given  in  the  motor  model:  T^  s  Kti-  In 
that  caae,  and  in  moat  motor  apedficationa,  the  Kt  ia  already  acaled  by  ^f.) 

If  offaet  errora  and  relative  waveform  magnitudea  are  included  in  each  phaae,  the 
currenta  become: 


t,  =  Acos{n0)  +  (4.27) 

U  =  Beos{n9  +  120")  +  6^  (4.28) 

By  combining  equationa  4.23,4.26,  and  4.28  the  motor  output  torque  becomea: 

T^  =  ^Kt{Acos^{n9)  +  Bain\n0))  +  \)JlKt{B  -  A)ain{2n0) 

■^2^Kt{SaSin{0  +  120")  -  Sisin(n9)) 


(4.29) 
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Figure  4.4:  First  Harmonic  for  a  Three  Pole  Pair  Brushless  Motor. 

If  the  two  phase  current  waveform  magnitudes,  A  and  B,  are  equal  to  a  given  value 
of  i,  and  6a  —  6h  —  0,  the  output  torque  reduces  to  the  equation  given  in  4.26.  However, 
if  A  =  B  =  t,  but  ^  0,  the  resulting  equation  is 

Tm  =  +  \^S,K,sinin9  + 120»)  (4.30) 

This  clearly  shows  that  an  offset  in  one  of  the  phases  will  cause  a  ripple  at  the 
fundamental  frequency  of  n$.  This  ripple  is  independent  of  torque  and  should  remain 
constant  for  the  full  range  of  torques.  Figure  4.5  shows  a  prediction  of  the  first  harmonic 
for  a  brushless  motor  with  three  magnet  pole  pairs  (n  =  3). 

Another  major  cause  of  ripple  can  be  seen  by  assuming  the  waveform  magnitudes  are 
unequal,  A  =  B  +  Aa,  with  5^  =  =  0.  Equation  4.29  then  takes  the  form 
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r«  =  )J^KtB  +  ^KtA^cos^inB)  -  i^/i:,A.«n(2n^)  (4.31) 

Using  the  identity  eos^B  =  |  +  ^cos29 

T„  =  ^ir,(B  +  ^)  + J|ir,A.co.(2n»  +  J0')  (4.3J) 

This  equation  demonstrates  that  a  difference  in  the  current  waveform  magnitude  of 
two  phases  of  the  motor  can  generate  torque  ripple  at  twice  the  fundamental  driving 
frequency  of  nB.  The  magnitude  of  this  ripple  harmonic  would  be  approximately 
times  the  phase  gain  error.  Since  this  error  is  in  the  phase  gain,  it  will  scale  with  the 
commanded  torque.  Additionally,  the  DC  component  of  the  torque  will  be  the  average 
of  the  two  phase  gains,  as  seen  in  the  first  term  of  4.32.  Figure  4.5  shows  the  estimated 
second  harmonic  component  of  ripple  at  torque  commands  of  1.0  and  5.0  in-lb. 

Several  other  factors  can  influence  torque  ripple,  although  much  less  significantly  than 
the  first  two  harmonics.  A  current  loop  deadband  in  the  controller  can  cause  a  limit  cycle, 
which  then  manifests  itself  as  torque  ripple.  Unmodded  spadal  harmonics  in  the  motor 
may  also  cause  ripple  unless  compensated  by  higher  order  waveforms  superimposed  on 
the  commutation  waveform.  Indepth  analysis  of  these  and  other  causes  of  ripple  can  be 
found  in  several  references.  Paul  [Paul  87]  modded  the  first  two  harmonics  for  Moog 
brushless  motors,  and  fed  forward  the  appropriate  currents  to  caned  some  of  the  ripple 
effect.  He  was  able  to  reduce  the  torque  ripple  by  as  much  as  50%.  LeHuy,  Perret,  and 
Feuillet  [Le-Huy  86]  modded  the  spacial  harmonics  of  a  three  phase  disk-type  motor  by 
monitoring  the  back  EMF  in  the  phase  windings.  They  then  modified  the  commutation 
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waveforms  to  reduce  the  low  frequency  harmonic  ripple  by  70%. 

4.6  Friction  Models 


There  is  a  measurable  amount  of  friction  in  the  actuator  system.  It  takes  the  form  of 
Coulomb  friction,  stiction,  and  viscous  damping.  While  it  is  possible  to  lineariie  viscous 
damping  as  a  function  of  velocity,  both  Coulomb  friction  and  stiction  are  discontinuous  at 
zero  velocity.  These  non-linear  properties  may  cause  limit  cycling  and  other  tmpredictable 
behavior  in  the  regions  where  they  are  discontinuous. 

These  three  models  of  friction  can  be  seen  in  figure  4.6.  In  the  Coloumb  friction  model 
the  friction  torque  is  constant  for  all  velocities  except  zero,  where  it  switches  sign.  This 
essentially  causes  a  deadband  that  is  the  magnitude  of  the  friction.  Many  controllers 
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Coulomb  Friction  Stiction  Viscous  Damping 


Figure  4.6:  Common  Models  of  IViction. 

utilize  a  feedforward  compensation  technique  to  minimize  the  effect  of  Coulomb  friction. 

Stiction  compounds  this  problem  by  adding  a  higher  breakaway  torque  to  the  constant 
Coulomb  friction.  This  makes  it  virtually  impossible  to  control  small  velocities  since  the 
controller  has  to  overcome  the  stiction  without  overshooting  the  target  torque.  Feedfor¬ 
ward  techniques  are  not  as  accurate  as  those  for  Coloumb  friction,  as  the  controller  needs 
to  switch  between  the  modeled  stiction  value  and  the  Coloumb  value. 

Linear  friction,  on  the  other  hand,  is  fairly  simple  to  model.  A  first  order  approxi¬ 
mation  of  the  friction  as  a  fonction  of  velocity  is  usually  adequate  for  most  applications. 
Unfortunately,  linear  damping  rarely  occurs  without  one  of  the  other  friction  types.  The 
bearings  supporting  the  motor  shaft,  for  example,  exhibit  stiction  like  behavior  at  zero 
velocity,  but  change  to  linear  damping  for  all  other  velocities. 

In  open-loop  force  control  applications  the  various  forms  of  friction  can  seriously 
corrupt  the  output  torque.  The  Coloumb  friction  and  stiction  not  only  act  as  a  deadband, 
but  subtract  directly  from  the  output  torque.  The  linear  damping  causes  a  disturbance 
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in  torque  that  varies  proportionally  with  speed.  Ail  of  these  forces  have  the  effect  of 
reducing  the  actual  torque  to  below  the  command. 

A  properly  designed  closed-loop  torque  controller  should  be  able  to  compensate  for 
all  of  these  effects  with  the  possible  exception  of  stiction.  Since  the  error  induced  by 
Coloumb  friction  is  constant,  an  integral  controller  is  required  to  drive  the  error  to  sero. 
The  same  is  true  for  the  linear  damping,  provided  that  the  rate  of  change  in  motor  speed 
is  not  greater  than  the  integral  gain.  This  method  will  not  always  work  when  stiction 
is  present.  The  controller  may  constantly  overshoot  the  stiction  level  in  one  direction, 
and  then  overcompensate  in  the  other.  This  would  cause  a  stable  limit  cycle  about  the 
stiction  value.  If  the  sensor  and  actuator  were  fast  enough,  it  is  possible  to  break  out  of 
this  limit  cycle  and  minimize  the  torque  error. 


Chapter  5 
Results 


This  chapter  will  ditcuu  the  performance  of  the  actuator  under  both  open  and  closed 
loop  control.  Data  plots  are  included  to  illustrate  the  effects  of  friction  and  ripple. 

5.1  Open  Loop  Actuator  Characteristics 

This  section  includes  the  baseline  characteristics  of  the  actuator  system.  Before  proceed¬ 
ing  to  the  open  loop  control  accuracy,  we  will  first  discuss  the  methods  used  to  determine 
the  friction  in  the  system,  and  how  to  accurately  calibrate  the  sensor. 

5.1.1  Bearing  Friction 

As  discussed  in  the  previous  chapter,  there  is  a  measurable  amount  of  bearing  friction  in 
the  actuator  system.  This  friction  can  best  be  seen  by  a  comparison  of  the  clockwise  and 
counterclockwise  torques  measured  with  the  motor  disabled,  as  seen  in  figure  5.1.  The 
offset  between  the  two  curves  is  approximately  0.13  in-lb  and  stays  relatively  constant. 
This  deadband  between  the  two  curves  is  a  characteristic  of  stiction  and  Coulomb  friction. 
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Figure  5.1:  Clockwise  end  Counter  Clockwise  Torque  with  Motor  Disabled. 

Since  these  measurements  were  taken  at  a  constant,  non-sero  Telodty,  this  offset  must 
be  due  to  Coulomb  friction.  In  roller  beatings,  Coulomb  friction  should  be  equal  in  both 
directions,  therefore  it  is  half  of  this  deadband  value,  or  ±  0.065  in-lb. 

5.1.2  Sensor  Calibration 

The  bearing  friction  described  above  makes  it  very  difficult  to  calibrate  the  sero  point 
of  the  torque  sensor.  In  order  to  minimize  the  offset  error,  the  motor  is  commanded  to 
exert  an  open  loop  torque  of  0.1  in-lb  in  the  clockwise  direction.  Several  tcsque  samples 
are  taken  after  the  system  has  reached  this  steady  state  torque.  The  torque  command 
is  then  set  to  0.0,  the  motor  disabled,  and  more  samples  are  taken.  The  same  procedure 
is  then  repeated  for  torques  of  -0.1  in-lb  and  0.0  again.  Each  of  the  0.0  in-lb  tests  is 
averaged  individually  and  then  together  to  determine  the  offset.  The  ±  0.1  in-lb  samples 
are  used  to  determine  if  the  gain  calibration  of  the  sensor  agrees  with  the  amplifier  gain. 
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Figure  5.2:  Effect  of  Ripple  on  CW  and  CCW  Rotation. 


5.1.3  Torque  Ripple 


The  effect  of  torque  ripple  can  be  seen  very  clearly  in  figures  5.2  and  5.3.  Figure  5.2 
shows  the  ripple  with  a  0  in-lb  commanded  torque.  The  motor  shaft  was  rotated  by 
hand  in  both  the  dockwise  and  counterclockwise  directions.  The  first  order  harmonic  of 
3  cycles  per  revolution  is  plainly  visible.  It  has  a  peak  to  peak  magnitude  of  about  0.3 
in-lb,  and  remains  for  all  values  of  torque.  The  offset  between  the  two  curves  is  due  to 
the  bearing  friction  as  mentioned  above. 

Figure  5.3  shows  the  second  order  harmonic  torque  ripple.  This  was  found  by  sub¬ 
tracting  the  first  order  harmonic  ripple  in  figure  5.2  from  the  actual  torque  generated 
with  an  open  loop  torque  command  of  5.0  in-lb.  The  effect  of  this  6  cycles/rotation 
waveform  can  be  seen  by  the  way  the  peaks  of  the  open  loop  torque  plot  are  alternately 
truncated  and  expanded.  The  open  loop  torque  is  no  longer  the  smooth  sine  wave  it  was 
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at  zero  command. 


5.2  Open  vs  Closed-Loop  Performance 

The  quasi-static  torque  accuracy  of  the  actuator  was  measured  by  commanding  a  torque 
and  then  rotating  the  shaft  through  one  complete  revolution  by  hand.  The  duration  of 
rotation  was  approximately  1  second.  Tests  were  performed  in  both  directions  of  rotation 
to  determine  the  effects  of  friction. 

The  compensation  for  the  closed-loop  testing  consisted  of  a  standard  PID  controller 
with  unity  feedforward  of  the  open-loop  command.  Several  different  gains  were  studied. 
The  system  was  very  robust  for  low  gains.  A  simple  integrator  was  the  only  compensation 
required  to  eliminate  the  steady  state  error.  Various  proportional  and  derivative  gains 
were  implemented  to  determine  their  effect  on  response  time  and  settling.  A  high  pro- 
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Figure  5.4:  Open  and  Closed  Loop  Torque  at  0  in-lb  Command. 

portional  gain  wiik  very  low  derivative  and  integral  gains  produced  the  fastest  response, 
yet  was  stable  with  high  accuracy  under  all  conditions. 

A  plot  of  the  closed  loop  0.0  in*lb  torque  has  been  superimposed  on  the  corresponding 
open  loop  torque  in  figure  5.4.  The  open  loop  torque  shows  errors  of  up  to  0.2  in-lb  due 
to  ripple.  The  closed  loop  torque,  on  the  other  hand,  is  accurate  to  within  0.01  in-lb, 
which  is  the  noise  level  of  the  data  acquisition  system.  This  shows  an  improvement  by  a 
factor  of  20  by  closing  the  feedback  loop. 

Figure  5.5  shows  the  effect  of  static  friction  on  open  loop  torque,  and  the  negation 
of  this  disturbance  by  the  feedback  controller.  Notice  that  the  two  open  loop  curves  are 
offset  by  approximately  0.13  in-lb,  the  value  calculated  above  in  section  5.1.1.  Errors 
in  the  open  loop  case  reach  as  high  as  0.38  in-lb,  while  the  closed  loop  torque  is  always 
within  0.01  in-lb  of  the  set  point. 


Actual  ToiquB  (Mb)  Actual  Tonfua  (Mb) 
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Figure  5.5:  Open  Loop  Torque  in  Both  Directions  at  0.5  in*lb  Command 
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Figure  5.6:  Open  and  Closed  Loop  Torque  at  S.0  in-lb  Command. 

Figure  5.6  shows  the  open  and  closed  loop  torque  for  a  command  of  5.0  in-lb.  The 
closed  loop  torque  has  been  enlarged  as  figure  5.7  to  show  that  the  peak  deviation  from 
command  is  only  0.02  in-lb.  Since  this  accuracy  is  virtually  independent  of  torque,  it 
will  remain  near  this  level  for  all  commands  up  to  peak  torque.  This  value  corresponds 
to  an  accuracy  of  0.13%  over  the  continuous  torque  range,  giving  a  dynamic  range  of 
750:1.  If  we  disregard  only  10  of  the  4000  data  points,  the  error  is  halved  to  0.07%,  and 
the  djmamic  range  doubles  to  1500:1.  Either  value  is  an  order  of  magnitude  better  than 
the  open  loop  error  of  more  than  0.35  in-lb.,  or  2.3%.  By  comparison,  the  Moog  303-003 
motors  currently  being  used  in  the  are  accurate  to  about  1.0  in-lb  at  foil  torque, 

or  6.6%. 
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Figure  5.7:  Magnification  of  Closed  Loop  Torque  at  S.O  in4b  Command. 

5.3  Dynamic  Response 

The  frequency  response  of  the  actuator  system  was  measured  using  a  Hewlett-Packard 
spectrum  analyser.  The  unit  contained  a  signal  generator  which  produced  a  white  noise 
input  to  the  system.  The  output  torque  was  fed  back  into  the  analyser,  and  a  Fast 
Fourier  Transform  was  performed  between  the  input  and  output  torque.  The  resulting 
magnitude  and  phase  plots  for  the  open  loop  system  can  be  seen  in  figure  5.8.  As  can 
be  seen  from  these  plots,  the  response  is  perfectly  flat  at  0  dB  until  about  200  Hs  where 
it  starts  to  rise.  At  approximately  300  Hz,  the  response  peaks  to  about  20  dB,  and  then 
falls  off  rapidly.  This  response  is  characteristic  of  a  second  order  system  with  a  natural 
frequency  of  300  Hz.  The  rise  is  caused  by  the  excitation  of  the  resonant  mode,  with  a 
40  dB/decade  roll  off  due  to  the  double  pole.  The  phase  slowly  shifts  until  it  crosses  90° 
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at  about  275  Hs.  It  then  falls  off  steeply  and  until  it  crosses  180”  very  close  to  300  Hz. 
This  test  was  repeated  nnder  several  different  conditions:  with  the  rotor  freely  rotating, 
lightly  damped,  and  rigidly  fixed.  The  frequency  response  for  all  situations  was  identical, 
showing  that  the  stator  and  rotor  are  completely  decoupled,  as  predicted  by  the  sensor 
model. 

The  response  in  figure  5.8  plainly  shows  the  double  pole  at  the  motor-sensor  resonant 
frequency.  However,  it  does  not  show  the  low  frequency  pole-zero  pair  predicted  by 
the  motor  model.  To  achieve  better  resolution  at  low  frequencies  additional  testing  was 
performed  with  the  analyzer  bandwidth  reduced  to  12  Hz.  This  higher  resolution,  as 
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teen  in  figure  5.9,  shows  the  magnitude  dropping  to  -4  dB  at  very  low  frequencies,  rising 
slightly  at  about  4  Hz,  and  then  leveling  out  to  0  dB  at  7  Hz.  This  shows  that  the 
zero  and  pole  do  exist,  at  4  and  7  Hz,  respectively.  On  a  similar  test,  conducted  with  a 
lower  magnitude  white  noise,  the  results  were  significantly  different.  The  zero  and  pole 
appear  to  have  shift  right,  to  approximatdy  5  and  9  Hz,  respectively.  The  magnitude 
now  ranges  from  *10  to  +5  dB.  Since  the  amplitude  of  noise  exciting  the  system  is  the 
only  difference  in  these  tests,  this  change  must  be  due  to  a  nonlinearity.  One  possible 
cause  is  the  friction  in  the  bearings.  For  high  noise  amplitudes,  the  bearings  exhibit 
viscous  damping,  but  fall  into  the  Coulomb  friction  range  for  low  amplitudes.  The  effect 
of  Coulomb  friction  and  stiction  would  tend  to  move  the  pole  and  zero  further  away  from 
the  imaginary  axis.  A  frequency  response  plot  of  this  phenomena  can  be  seen  in  figure 
5.10. 

Similar  frequency  response  analysis  was  performed  on  the  system  through  the  con¬ 
troller.  With  the  controller  commanding  an  open  loop  torque,  the  response  was  virtually 
identical  to  that  found  for  the  system  without  the  controller.  The  magnitude  peaked  at 
the  same  300  Hz  frequency,  but  the  phase  was  slightly  shifted.  This  phase  shift  corre¬ 
sponded  to 

^  =  2rfU  (5.1) 

where  /  is  the  frequency  and  td  is  the  dday  time  associated  with  the  digital  sampling 
and  loop  execution  speed.  For  this  system,  td  =  0.001  seconds.  At  lower  frequencies  this 
shift  was  not  significant,  but  at  frequencies  near  500  Ez  the  shift  was  180°. 

While  the  low  frequency  pole  and  zero  are  not  readily  apparent  in  the  frequency 
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Figure  5.11:  Step  Response  of  the  Open  Loop  System. 
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response,  they  we  very  obvious  in  a  time  response.  Figure  5.11  shows  the  response  of  the 
actuator  subjected  to  a  step  torque  input  of  1.0  in-lb.  The  rise  time  of  this  overdamped 
response  is  105  msec,  approximately  what  could  be  expected  from  a  system  with  a  pole 
between  7  and  9  Hs.  The  steady  state  error  in  this  system  is  0.035  in-lb. 

Although  the  low  frequency  pole  introduced  by  the  current  controller  severely  damps 
the  open  loop  response,  it  is  possible  to  speed  the  system  up  with  the  appropriate  com¬ 
pensation.  The  frequency  response  of  figure  5.8  shows  that  there  is  a  substantial  phase 
margin  up  to  about  200  Hz.  It  should  therefore  be  possible  to  increase  the  response 
significantly  without  instability. 

The  addition  of  a  high  gain  PID  controller  speeded  up  the  rise  time  by  a  factor  of 
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20  or  more  (figure  5.12).  For  one  set  of  gams,the  lyitem  croceed  the  command  torque  in 
5  msec,  and  settled  to  within  5%  in  11  msec  and  2%  in  20  msec.  In  tests  with  another 
compensator  the  rise  time  was  as  little  as  3  msec,  but  the  system  required  16  msec  to 
settle.  Using  the  rise  time  as  a  benchmark,  bandwidths  of  200  •  300  Hs  can  be  inferred. 
For  different  applications,  the  PID  gains  should  be  chosen  to  meet  the  particular  response 
or  settling  requirements  of  the  system. 

These  time  responses  could  probably  be  improved  by  closing  a  faster  servo  loop.  Since 
this  controller  was  running  at  only  1  kHc,  each  oscillation  corresponded  to  1  or  2  data 
points,  and  the  entire  rise  time  was  as  little  as  3  samples.  For  bandwidths  approaching 
200-300  Hz,  the  controller  should  have  a  servo  rate  of  more  than  3  kHz. 


Chapter  6 
Conclusion 

6.1  Summary 

As  the  field  of  robotics  expands,  more  emphasis  is  being  placed  on  manipulators  capable  of 
operation  in  unstructured  environments.  A  new  field,  H'hole  Arm  Manipulaiion,  has  been 
developed  to  address  some  of  the  problems  associated  with  unstructured  environments. 
A  WhoU  Arm  Manipulator  is  capable  of  grasping  and  moving  objects  with  its  links  in 
addition  to  using  an  end-effector.  Since  the  workspace  is  no  longer  constrained  to  be  at  the 
end-effector,  the  manipulator  must  be  able  to  identify  and  control  forces  anywhere  along 
its  links.  Rather  than  instrument  the  entire  arm  with  sensors,  a  method  was  developed 
to  infer  contact  forces  and  locations  from  joint  torques.  Since  this  solution  may  be  poorly 
conditioned  in  some  configurations,  accurate  torque  control  and  measurement  is  critical 
to  the  force  control  and  collision  detection  of  the  WAM. 

A  closed  loop  torque  controlled  actuator  was  developed  to  provide  smooth,  accurate 
torques  and  minimize  the  errors  assodated  with  ripple,  friction,  and  other  disturbances. 
The  actuator  uses  a  reaction  torque  sensor  to  measure  the  actual  torque  exerted  by  the 


80 


CHAPTER  6.  CONCLUSION 


81 


motor.  A  proportional  +  integral  +  derivative  controller  wa«  implemented  to  minimize 
the  torque  error  and  decrease  the  response  time. 

This  thesis  studied  the  issues  involved  in  designing  an  actuator  for  torque  control. 
Motor  and  sensor  characteristics  for  accurate  torque  control  were  discussed  in  detail.  A 
permanent  magnet  bnishless  motor  was  selected  for  its  high  torque  output,  low  friction, 
and  reliable  operation.  The  reaction  torque  sensor  was  chosen  over  the  inline  and  joint 
mounted  sensors  to  decouple  the  transmission  dynamics  from  the  feedback  loop.  This 
enabled  the  system  to  obtain  a  much  higher  bandwidth  than  the  manipulator  dynamics 
would  have  allowed. 

Each  of  the  major  components  of  the  actuator  was  modeled  to  predict  the  overall 
system  response.  Additional  modeling  was  performed  to  ana'yze  the  nonlinear  effects  of 
torque  ripple  and  the  various  types  of  friction. 

Open  and  closed  loop  tests  were  conducted  to  compare  the  accuracy  of  the  sensor 
and  controller.  Open  loop  errors  were  found  to  be  as  large  as  0.35  in-lb  for  a  5.0  in¬ 
lb  command,  or  7%.  These  errors  are  primarily  due  to  torque  ripple  and  offset  caused 
by  Coulomb  friction  in  the  bearings.  The  closed  loop  system  is  capable  of  controlling 
torque  accuracy  to  within  0.01  in-lb  over  a  ±15  in-lb  range,  for  less  than  0.1%  error. 
The  dynamic  range  provided  by  this  system  is  on  the  order  of  1500:1,  with  the  accuracy 
limited  by  the  quantisation  noise  of  the  sensor  and  electronics. 

The  sensor  bandwidth  was  found  to  be  approximately  300  Hz,  which  was  slightly 
higher  than  estimated  and  three  times  larger  than  required.  The  frequency  response 
analysis  showed  that  the  system  behaved  as  a  textbook  second  order  system.  However, 
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there  was  a  hidden  pole-zero  pair  at  very  low  frequncies  due  to  the  current  control  scheme 
utilized  in  the  drive  electronics.  This  limited  the  open-loop  bandwidth  to  less  than  10  Hz, 
with  a  corresponding  rite  time  of  about  105  msec  for  a  step  response.  A  PID  compensator 
has  been  shown  to  speed  up  the  response  to  3  msec,  predicting  a  controllable  bandwidth 
of  up  to  300  Hz.  This  demonstrates  that  it  is  possible  to  drastically  improve  the  response 
of  a  motor  by  closing  a  high  bandwidth  torque  loop. 

6.2  Problem  Areas 

The  greatest  problem  in  the  design  and  implementation  of  this  system  was  in  reducing  the 
electromagnetic  noise  produced  by  the  motor  controller.  This  noise  consisted  of  voltage 
spikes  up  to  10  volts  peak  to  peak,  and  were  generated  at  the  PWM  switching  frequency 
of  16  kHz.  This  noise  circulated  throughout  the  laboratory  and  could  be  picked  up  by 
the  oscilloscope  as  far  as  20  feet  away.  The  computer  cage  and  rack  acted  as  a  large 
antenna,  putting  the  noise  back  into  the  torque  and  position  signals  that  had  been  so 
carefully  amplified  and  filtered.  All  of  the  cables  had  to  be  double  shielded  and  tied  to 
a  common  ground.  Bypass  capacitors  were  liberally  used  to  filter  the  noise  out  of  signal 
and  power  lines.  Eventually  most  of  the  noise  was  filtered  out  by  all  of  the  hardware 
precautions  in  conjunction  with  a  software  low  pass  filter. 

One  of  the  worst  problems  encountered  in  a  design  project  such  as  this  is  receiving 
custom  made  parts  in  a  timely  manner  and  to  specifications.  Both  the  motor  and  sen¬ 
sor  were  several  weeks  late  and  had  major  differences  from  the  original  design.  This 
necessitated  a  complete  redesign  of  the  actuator  housings  to  accomodate  the  deviations. 
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Other  minor  problems  included  motor  •  driver  compatibility  and  resolver  phasing. 
The  motor  and  resolver  were  sent  to  In£ranor  so  that  the  amplifier  could  be  properly 
tuned  to  the  motor  characteristics  and  phased  correctly.  This  caused  a  delay  of  three 
weeks  in  the  implementation. 

6.3  Future  Research 

The  intent  of  this  research  was  to  develop  a  method  and  hardware  to  provide  a  very  high 
accuracy  torque  source  for  the  MIT  WAM.  It  is  expected  that  this  prototjrpe  actuator 
will  be  installed  on  the  WAM  in  the  very  near  future.  If  the  implementation  of  this  first 
system  proves  to  be  successful  in  improving  the  force  accuracy  and  position  detection  of 
the  manipulator,  additional  actuators  would  be  installed  for  the  other  three  joints.  The 
computational  power  reqtured  to  control  aU  of  these  actuators  would  then  be  significantly 
greater  than  that  currently  provided  by  the  Condor  devdopment  system.  Individual 
controller  boxes  would  need  to  be  designed  to  perform  all  data  collection  and  control 
for  each  motor.  These  modules  would  be  able  to  receive  a  torque  command  from  the 
supervisory  computer,  read  the  actual  torque  put  out  by  the  motor,  and  close  the  torque 
loop.  It  would  also  return  motor  information  such  as  position,  vdocity,  and  temperature 
to  the  host.  This  would  alleviate  the  Condor  system  or  other  high  levd  controller  of  the 
computational  burden  of  filtering  the  position  and  vdodty  data  and  closing  the  servo 
loop. 

Another  improvement  in  this  system  would  be  the  devdopment  of  a  scheme  to  feed¬ 
forward  some  of  the  ripple  and  friction  terms.  This  would  decrease  the  required  control 
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effort  and  improve  the  accuracy  of  the  system  for  higher  rotational  velocities.  A  very 
fast  observer  or  estimator  model  would  also  increase  the  response  speed  of  the  actuator. 

Hardware  improvements  include  a  method  to  eliminate  the  switching  noise  caused  by 
the  PWM  amplifier.  The  shielding  and  filtering  reduced  the  noise  to  managable  levels, 
but  increased  wiring  complexity  and  caused  propagation  delays  in  some  of  the  signals. 
Alternative  drive  electronics  should  be  investigated  to  find  a  solution  to  this  problem. 
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For  details  of  holes  through  the  housing,  see  MOL-l-tOO.IC 
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Miniature  Reaction 
Torque  Transducers 

Models  QWFK-8M  and  QWLC-8M 


Compact  size 
High  frequency 
0.1^  linearity 


M«d«<  QWFK-SM 


SENSOTEC't  Models  OWFK-8M  and 
OWLC-8M  Miniatura  Reaction  Torque 
Transducers  are  engineered  lor  minimufn  sus 
and  to  achieve  an  imprassive  O.t^  maximum 
non-iir>earity.  Four  bonded  strain  gages  are 
positioned  on  a  special  machined  portion  o( 
the  tranaducer  to  attactively  measure  even 
slight  torque  motion.  These  models  operate 
and  ara  calibrated  in  both  directions.  A 
modular,  stainless  steal  construction  and  no 
moving  parts  provide  excellent  durability 
under  harsh  industrial  corKfitions.  Typical 
Miniature  Reaction  Torque  Transducer  ap¬ 
plications  indude  motor  dynamometer,  fire 
braking,  twist  measurement,  torque  tables. 
Slid  Iriction-skid  teat  measurements. 


PERFORMANCE 

Model  QWFK-SM 

Order  Cede  erst  t 

Model  QWLC-8M 

Order  Code  eT3i2 

Torque  ranges  . 

Nen^jneemy  (max) 

Hysteraais  (max)  . 

Hon  nepaaiibiiHy  (max) 

Output 

Resolution 

2S  m/os  to  300  in/lb. 

♦  /•0.1HFS 

♦  /•0.1H  F.S. 

♦  r-O.OSH  F.S. 

2mv/v 

Infinite 

26  infox  to  300  in/lb. 

♦  /•0.1H  F.S. 

V/-0.1H  F.S. 
v/'O  OSH  F.S 

2mvfv 

InlinMe 

ENVIRONMENTAL 

Temperature,  Operating 
Tempersure,  Compensated 
Tempereture  EHoct 

•  Zero  (max) . 

•  Span  (max) 

•es*  F  to  225*  F 

SO*  F  to  too*  F 

.005H  F.S.r*  F 
.005H  Rdg./*  F 

«•  FI0  225*  F 

80*  F  to  180»  F 

OOSH  F  $./•  F 
.0064*  Rdg./*  F 

ELECTRICAL 

Strain  Gage  Type . 

Exckaiion . 

Bndge  Resistanee  . 

Winng  code  (std) . 

Eieetneal  Termination  (std) 

DOnOVO  VON 

10VOC 

360  ohms 
ft  (See  P.  143) 

Teflon  cable  (6  ft.) 

Bonded  lei 

10VOC 

360  ohms 
#1  (See  P  1*3) 

Tenon  cable  (5  It.) 

MECHANICAL 

^rtoadSale . 

Caae  Material . 

604*  over  capadiy 

Dtainieee  steel 

604*  over  capacity 

Stainiees  steel 

DIMENSIONS 

Mo<M  QWFK<«M  (Order  Cede  STSt  1)  AvdMie  Nangsa 

Model  QWLC-SM  (Order  Cede  STSIZ)  2S;  too;  2S0  mexs. 

SO;  too-,  300  in«e. 

OPTIONS  Temparaiute  eompeneaied  16,  ic,  if  <See  F.  154) 
PREMIUM  OPTIONS  id,  ie  (See  P.  iM) 
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INFRANOR 


Brushless  Motor  Controllers 

SMTB  Series 


Th.  SMTB  S«ri«t  ■•rvo-ampliti«ra 
d*tign«d  to  control  oithor  AC  or  DC 
BrushiMS  Mrvomolora  art  construciod 
on  6U  Euro<card  format  and  ara  rack 
mounttMa.  Tlw  powrar  supply  moduta  « 
also  on  Eurocard  format  and  plugaMa 
Into  sama  rack  with  tha  contiollar  (aarvo- 
amp)  modulas. 


With  tha  SMTB  systam,  controllar 
modulaa  and  powar  supply  modula  tor 
six  axis  can  ba  mouniad  in  a  standard  19* 
rack.  Each  axis  modula  has  its  own  logw 
supply  which  is  darivad  from  tha  DC  bus 
volt^. 

For  singto  axis  appUcabona.  tha  oontroHsr 
modula  is  plug  moumad  into  tha  "bloc” 
powar  supply  BMT3S0  which  pnwidaa  ad 
raquirad  powar  and  braking  ragulalor 
circuitry.  This  providas  for  a  compact 
panal  mount  controllar  unit. 


Features 

•  Controls  AC  or  DC  Brushless  Servomotors 

•  Controls  Motors  with  Resolver  or  Hail  Effect  Sensors 

•  Single  Axis  Drives  with  Integral  Power  Supply 

•  Multi-Axis  Rack  Mounted  Configurations 

•  Up  to  Six  Axis  Provided  in  a  19"  Rack 

•  Requires  Only  Single  Power  Source  (220  Vac) 

•  Fully  Fault  Protected 

•  Digital  Readout  For  Fault  Analysis 

•  Total  Isolation  of  Power  Section  From  Logic 

•  16  kHZ  PWM  Switching 

•  310VDCBUS 
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SMTB  Controller  Modules 


GtnemI  $i)»clllcatlons 


OPEWCriNG  VOITAQE . 

AUXlUARy  VOtWGE . 

INPUT  CX3MMANO . 

FEEDBACK  DEVICE  REQUIRED 
SinuMidai  AfflpMitr . 

IripnOKMI  AmpNIWr . 

INPvfT  IMPEDANCE . 

COMPENSATION  NETWORK . 

SWrrCHINQ  FREQUENCY . 

SPEED  RANGE . 

CURRENT  MONITOR . 

ADJUSTMENTS  (Fronl  P«n«0 . 

FAUtr  DIAGNOSIS . 

OPERAPNG  TEMPERATURE . 

COOUNG  . 


. DC  Bus:  310  VDC  10%/-15% 

. 48  VDC  or  DC  Bus  310  VDC 

. ±10  VDC 

....  Rssolvvr  (rsosivor  or  transmitlsr) 

. Hsil  Effisct  &  Brushlsss  Tach 

. 20K  Ohms 

Adjuslabls  or  RnotMHzstion  Board 

. 15-17  kMr 

. 10000:  1 

. ±  10  VDC 

. OKssi  -  Max  Spasd  -  Gain 

. Digitai  Display 

. 0-46 dag.  C 

. Natural  oorMscbon  or  toresd  air 

(dspartdirtg  on  output  currant  rating) 


Output  Power  Ratings 


ShweolM  Amplifiers 
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